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Prólogo 


El presente material consiste en una versión de los temas que he impartido a nivel 
Ingeniería en las clases de Robótica. El conocimiento de dichos temas fue adquirido 
gracias a las clases de modelado matemático recibidas por parte del Dr. Alexander $. 
Poznyak, así como por la lectura de excelentes libros y artículos presentados por una 
amplia variedad de autores, entre los que se encuentran O. Khatib, M. Spong, J. Craig, 
A. de Luca, entre muchos otros. Lo que se presenta en esta obra busca proporcionar 
un conjunto de conocimientos necesarios para adentrarse en el fascinante mundo de la 
Robótica, comenzando desde los aspectos básicos del análisis cinemático de los robots 
manipuladores, hasta la determinación de las ecuaciones dinámicas de los mismos, las 
cuales sirven como punto de partida para un análisis más profundo acerca del control 
de robots manipuladores. 


Uno de los aspectos de mayor importancia que se ha buscado cubrir en el presente 
trabajo consiste en desarrollar la descripción, análisis y ejercicios tomando en cuenta 
siempre la sencillez, de modo que cualquier lector pueda, tanto apreciar lo interesante 
que es el análisis de los robots, como lograr contemplar la belleza que llevan en sí las 
ecuaciones matemáticas que describen a los manipuladores. Debido a ello es que se ha 
desarrollado el texto empleando un vocabulario ameno para el lector, para que éste 
sólo se concentre en enriquecer sus conocimientos. 


No obstante a lo anterior, al igual que con muchas disciplinas de la ingeniería, 
siempre es necesario contar con ciertos conocimientos básicos. Este caso no es la ex- 
cepción, y se consideran deseables los conocimientos básicos acerca de cálculo vectorial 
y álgebra lineal; sin embargo, el texto se ha desarrollado de tal manera que sean mí- 
nimos los requerimientos que deban poseerse y, en los casos necesarios, se introducen 
algunos conceptos adicionales que permiten al lector contar con una fuente directa de 
los conceptos analizados. 


Como es de esperarse, no sólo la teoría puede hacer que el lector aprenda de modo 
integral los conceptos analizados. Debido a ello es que se incluyen una serie de ejerci- 
cios resueltos, con la finalidad de que el lector aplique los conocimientos estudiados a 
una cierta clase de robots que pudiera encontrarse en la realidad. Además, a partir del 
análisis de dichos ejemplos se espera que el lector sea capaz de generar las habilidades 
necesarias para aplicarlos a cualquier robot manipulador que pudiera encontrarse, 
siempre que se satisfagan las condiciones establecidas en el presente material. 
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Prólogo XIII 


Competencias Generales 


De modo general, al concluir el material presentado en el libro el lector habrá desa- 
rrollado las siguientes competencias: 


1. Obtener, mediante diferentes métodos, el modelo cinemático de robots mani- 
puladores en diferentes configuraciones. 


2. Obtener las ecuaciones dinámicas de robots manipuladores de cadena cinemática 
abierta. 


Lo anterior describe de modo general el objetivo que se persigue en el material que 
se presenta, ya que se tiene en mente que el lector sea capaz de poseer las bases 
suficientes de análisis cinemático y dinámico de robots manipuladores, a fin de que 
posteriormente sea capaz de comprender y aplicar fácilmente los conceptos para el 
control de robots manipuladores. 


Contenido del Texto 


Los temas que se desarrollarán en el texto incluyen: 


a Uso de sistemas de referencia para describir un cuerpo en el espacio. 
a Matrices de Rotación y de Transformación Homogénea. 

= Cinemática directa empleando la convención de Denavit-Hartenberg. 
s Jacobiano de un robot manipulador. 

a Tensor de inercia. 


a Ecuaciones de Newton-Euler y Euler-Lagrange. 


Cada uno de los temas mencionados anteriormente es de gran importancia en el 
análisis de los robots. Como se verá durante el desarrollo del texto, algunos conceptos 
básicos de cinemática directa pueden ser suficientes para lograr controlar un robot 
determinado. Sin embargo, debido a que en la actualidad los requerimientos de de- 
sempeño de los manipuladores son más exigentes, es necesario contar con una mejor 
descripción del sistema bajo consideración, para así poder diseñar una estrategia de 
control que permita obtener un mejor desempeño. Por lo tanto, el objetivo final del 
texto será obtener las ecuaciones dinámicas que describen a un robot manipulador. 
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XIV Prólogo 


Problemas Propuestos 


Como es de esperarse, al igual que la mayoría de las cosas con las que se enfrenta uno 
día a día, no hay mejor práctica que la solución de ejercicios para verificar que se ha 
comprendido un tema de modo adecuado, así como para reforzar los conocimientos 
que ya se han adquirido. Debido a lo anterior, al final de cada Capítulo se incluyen 
una lista de ejercicios que permitirán al lector verificar la comprensión que ha tenido 
de los temas estudiados. De modo general los problemas planteados se organizan de 
la siguiente manera: 


1. Primer conjunto de problemas. Los primeros ejercicios de la lista corresponden 
a preguntas relacionadas con los aspectos teóricos desarrollados en la Unidad 
correspondiente. Algunos de estos problemas enfatizan los conceptos de mayor 
importancia. Otros problemas se enfocan en determinar si el lector realmente 
ha comprendido la teoría presentada. 


2. Segundo conjunto de problemas. Luego de una serie de preguntas teóricas, se 
identifican fácilmente los problemas que involucran cálculos matemáticos. Di- 
chos problemas tienden a verificar la comprensión de las metodologías estudia- 
das en la Unidad correspondiente. La solución de dichos ejercicios permitirá al 
lector reforzar los conocimientos teóricos para su aplicación en la solución de 
problemas con robots manipuladores. 


3. Problemas de programación. De modo adicional, se incluyen algunos ejercicios 
que requieren el uso de herramientas computacionales. Dichos ejercicios son de 
gran ayuda para el lector, ya que permiten no solo incrementar las capacidades 
adquiridas, sino también mejorar la compresión de los temas. En ellos, el lector 
deberá crear programas, rutinas, funciones, etc. De este modo, el lector se verá 
en la necesidad de replantear el enfoque de los temas, de modo que sea capaz de 
trasladar sus conocimientos a un conjunto de instrucciones que la computadora 
sea capaz de interpretar. 


Como complemento, también se incluyen dos Apéndices. El primer Apéndice desarro- 
lla conceptos básicos de Álgebra Lineal que permitirán al lector ahondar en el estudio 
de las propiedades de los robots, pudiendo así comprender aspectos que le serán nece- 
sarios cuando se enfrente a un estudio avanzado de los robots manipuladores. Por otra 
parte, en el texto principal no se aborda el tema de cinemática inversa. Sin embargo, 
es posible que en ciertas aplicaciones se requiera realizar dicho procedimiento. Debido 
a ello es que en el Apéndice B se incluye un análisis de la cinemática inversa emplean- 
do un enfoque algebraico. Además, se incluye un ejemplo y simulaciones que permiten 
validar los cálculos desarrollados, así como clarificar el procedimiento al lector. 


Un aspecto adicional del texto es que, en la parte final de los Capítulos, se incluyen 
un conjunto de ejercicios resueltos. En general se presentan todos los pasos requeridos 
para resolver el problema, para evitar que el lector se confunda en la aplicación de las 
metodologías que se presentan. 
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Se espera que el lector encuentre en este texto las bases que se requieren para 
poder comenzar un estudio más profundo en los manipuladores robóticos, pudiendo así 
comprender claramente los conceptos del interesante mundo de la Robótica. Además, 
se espera que el lector no solo sea capaz de realizar los cálculos que aquí se plantean, 
sino que también sea capaz de entender los conceptos y relacionar la parte matemática 
con la realidad, lo cual permitirá que su dominio sobre el tema sea integral. 


Para tener acceso al material de la plataforma de contenidos interactivos de 
este libro, siga los siguientes pasos: 


1. Ira la página: http://libroweb.alfaomega.com.mx 


2. Ira la sección Catálogo y seleccionar la imagen de la portada del libro, 
al dar doble clic sobre ella, tendrá acceso al material descargable. 


NOTA: Se recomienda respaldar los archivos descargados de la página web 
en un soporte físico. 
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Capítulo 1 
Antecedentes de la robótica 


1.1 Introducción 
1.2 Elementos que constituyen un robot 
1.3 Arquitecturas básicas de manipuladores 


robóticos 


1.4 Componentes finales de un manipulador 


1.5 Resumen 


1.6 Ejercicios 


2 Capítulo 1. Antecedentes de la robótica 


Podemos más de lo que sabemos, sabemos más de lo que com- 
prendemos y comprendemos más de lo que podemos explicar. 


Claude Bernard 


Competencias 
Al completar esta unidad el lector será capaz de: 
Identificar la evolución de la robótica hasta el estado actual. 


Distinguir los elementos que constituyen a un robot manipulador. 


Clasificar a un robot manipulador. 


Distinguir los diversos problemas que pueden abordarse empleando 
robots manipuladores. 


1.1 Introducción 


A menudo se escucha hablar acerca de la robótica en muchas áreas del conocimiento, 
especialmente en temas ingenieriles. Lo anterior se debe principalmente a la gran 
fascinación que causa el pensar en un robot como una máquina que se asemeja al ser 
humano, con las mismas capacidades que cualquier persona, interactuando con otros 
seres humanos y con los mismos robots, tomando decisiones, o incluso mostrando 
sentimientos y reaccionando de la misma forma que cualquier persona lo haría. 


Lo anterior se debe a que, en general, se ha difundido una imagen de lo que se 
debe de entender por robot, plasmando la idea de que se trata de seres antropomór- 
ficos que realizan las mismas funciones que los humanos, pero con una capacidad de 
procesamiento superior. Esta idea provocó que, en los inicios de la robótica, los seres 
humanos tendieran a sentir cierta adversión hacia los robots, quizá pensando que 
llegaría el momento en que dichas máquinas mostraran su superioridad sobre el ser 
humano, tendiendo a formar un nuevo orden y una forma de percibir la realidad que 
no fuera la más adecuada para los humanos. 


A pesar de lo indicado anteriormente, el estado actual de la Robótica se encuentra 
aún distante de dicho nivel de complejidad y avance que permita a los robots com- 
portarse con un nivel de avance semejante al del ser humano. Lo anterior se debe, 
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entre otras cosas, a la necesidad de alcanzar una sinergia entre una gran variedad de 
disciplinas de la ingeniería, antes de que se pueda concretar un proyecto de semejante 
envergadura. 


Para comenzar con los conceptos básicos de la robótica, es importante tener en 
cuenta que fué debido al dramaturgo checo Karel Capek en 1920, en su obra Rossum 's 
Universal Robots, que se introdujo por vez primera la palabra Robota, que significa 
trabajo realizado de modo forzado. 


La palabra robótica se empleó por primera vez por el científico y escritor de ciencia 
ficción Isaac Asimov en 1942, proponiendo en ese entonces las denominadas leyes de 
la robótica. 


Cuando se habla de robots, se deben de tener en cuenta las diferentes disciplinas 
que intervienen en el desarrollo de los mismos. Entre dichas disciplinas pueden men- 
cionarse las ingenierías mecánica, eléctrica y electrónica, así como las ciencias com- 
putacionales, matemáticas y economía, por mencionar algunas. Lo anterior hace evi- 
dente que, al hablar de robots, uno se introduce en un área demasiado amplia, cuya 
complejidad puede ir avanzando más y más dependiendo del tipo de aplicación que 
se desee tratar. En este momento es importante considerar la definición formal de un 
robot, de acuerdo al Instituto de Robots de América. 


Robot 


Un robot es un manipulador multifuncional reprogramable di- 


señado para mover materiales, partes, herramientas o disposi- 
tivos especializados a través de movimientos variables progra- 
mados para desempeñar una amplia variedad de tareas. 


Tomando en cuenta la definición anterior, al hablar de robots el pensamiento no debe 
limitarse a robots humanoides, ya que, en general, cualquier máquina que opere de 
modo autónomo y que sea reprogramable puede considerarse como robot. Una carac- 
terística fundamental de un robot es que puede llevar a cabo trabajos completamente 
diferentes, e incluso tomar decisiones según la información procedente del mundo 
exterior, mediante un conjunto adecuado de comandos o leyes de control. De esta 
manera, es posible pensar en una amplia variedad de máquinas que normalmente se 
encuentran en la vida diaria y que pueden considerarse como robots, por ejemplo: 
los autos de juguete que se encuentran con mucha frecuencia en cualquier tienda, 
los prototipos desarrollados por estudiantes (como pequeños brazos robóticos que 
se mueven y manipulan objetos), o robots de empresas automotrices (como brazos 
robóticos que manipulan partes y herramientas, y realizan de manera automática una 
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amplia variedad de tareas), por mencionar algunos ejemplos. Otro caso son los robots 
humanoides que se desarrollan por empresas especiales con objetivos de investigación, 
entretenimiento o interacción con los seres humanos. En este último caso, los robots 
deben poseer no solo habilidades de manipulación de objetos, sino también de una 
cierta clase de pensamientos o incluso emociones, lo cual permite incluir en el campo 
de la robótica a otras disciplinas del conocimiento, como la psicología y las ciencias 
sociales, para así construir el concepto y las bases de la robótica moderna. 


No es de extrañarse que los robots han ido cambiando y evolucionando a lo largo 
de los años, y algunas áreas específicas se encuentran bajo un mayor desarrollo. Esto 
permite pensar que el desarrollo que se seguirá teniendo en esta área será muy prome- 
tedor, los temas que se podrán seguir analizando serán cada vez más interesantes y la 
única limitante para el desarrollo de la robótica será la imaginación de los estudiosos 
y entusiastas del tema, así como el desarrollo tecnológico. 


Volviendo al surgimiento de la robótica, normalmente se considera que los robots 
surgen como una mezcla entre dos tecnologías: la teleoperación y las máquinas de 
control numérico (CNC, por sus siglas en inglés). Desde sus orígenes la robótica ha 
ido avanzando más y más, y en la actualidad se consideran aspectos de investigación 
muy interesantes como: el establecimiento de nuevas estrategias de control de sistemas 
teleoperados; problemas relacionados con los retardos de tiempo, debidos al medio de 
comunicación que permite la conexión entre el dispositivo maestro (comandado por un 
ser humano) y el dispositivo esclavo (que se encuentra interactuando con el medio); así 
como la denominada transparencia, que es un parámetro que permite establecer una 
medida de las sensaciones que percibe el operador de un robot cuando éste interactúa 
con el medio. 


En 1948, George Devol consideró el diseño de una máquina flexible, adaptable al 
entorno y de fácil manejo, y patentó un manipulador programable que fue el principio 
de lo que se considera un robot industrial. Posteriormente, R.C. Goertz desarrolló el 
primer teleoperador con el objetivo de manipular elementos radioactivos sin riesgo 
para el operador. La primera patente de un dispositivo robótico fue solicitada en 
marzo de 1954 por el inventor británico C.W. Kenward. Por su parte, Geoge C. Devol 
estableció las bases del robot industrial moderno. En 1956, Joseph F. Engelberger y 
Devol comenzaron a trabajar en la utilización de sus máquinas a nivel industrial, por 
lo cual crearon la Consolidated Controls Corporation, que más tarde se convirtió en 
Unimation (Universal Automation, Automatización Universal). 


El crecimiento de la robótica en Japón aventajó en un cierto tiempo a Estados 
Unidos debido a la formación de la primera asociación de robótica del mundo, de- 
nominada Asociación de Robótica Industrial de Japón (JIRA) en 1972. Dos años más 
tarde se formó el Instituto de Robótica de América (RIA), que en 1984 cambió su 
nombre por el de Asociación de Industrias Robóticas, manteniendo las mismas siglas. 
Posteriormente, el primer robot programable de Devol se convirtió en el robot PUMA. 
El concepto de dicho robot es el que se emplea en una gran cantidad de los robots 
actuales. 


Los primeros robots presentaban configuraciones denominadas esférica y antropomór- 
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fica, que se mencionarán posteriormente en este Capítulo, y sus aplicaciones eran 
básicamente de manipulación. En 1981 Hiroshi Makino, de la Universidad de Ya- 
manashi en Japón, desarrolló el concepto del robot de ensamblaje SCARA (Selective 
Compliance Assembly Robot Arm). 


En pocos años los robots se han posicionado en casi todas las áreas productivas, 
sustituyendo al hombre en aquellas tareas repetitivas y peligrosas. Debido a esto, es 
importante su estudio, abordando aspectos como: características cinemáticas, dinámi- 
cas y aspectos de control, ya que de esta manera puede logarse que los robots realicen 
nuevas tareas con un mejor desempeño. 


A continuación se indican algunas características de los robots que son importantes 
de comprender para comenzar con su estudio. 


1.2 Elementos que constituyen a un robot 


Los robots que se estudiarán y analizarán son los denominados robots manipuladores 
de cadena cinemática abierta. Estos robots constan de dos elementos fundamentales: 
eslabones y articulaciones. 


Los eslabones son los elementos mecánicos que constituyen la estructura del robot. 
Por medio de las articulaciones o uniones los eslabones pueden enlazarse entre sí 
para constituir la denominada cadena cinemática del robot. Dicha cadena cinemática 
puede ser de dos formas: abierta o cerrada. Cuando el dispositivo robótico cuenta 
con un conjunto determinado de articulaciones y eslabones y se llega a un punto en 
el cual el último eslabón no se encuentra conectado a ningún otro elemento se dice 
que dicho robot es de cadena cinemática abierta. En caso contrario el manipulador 
será de cadena cinemática cerrada. En general, los robots manipuladores tanto de 
cadena cinemática abierta como cerrada poseen propiedades que son de importancia 
en determinadas aplicaciones. 


Los eslabones de un robot manipulador presentan un movimiento relativo entre sí 
por medio de las articulaciones que los interconectan. Las articulaciones pueden ser 
de varios tipos, aunque las más comunes son las: rotacionales (rotativas) o trasla- 
cionales (prismáticas). Las articulaciones rotacionales permiten un movimiento re- 
lativo de tipo rotacional entre dos eslabones, mientras que las prismáticas permiten 
un movimiento relativo lineal. 


Dado un eslabón arbitrario, se le puede designar por medio de l;, donde el subíndice 
i indica que se trata del i-ésimo eslabón (la l se debe a su vocablo en inglés link). 
Entonces, se considera que la articulación ¿ conecta a los eslabones l; y li+1. Además, se 
asume que el eje con respecto al cual rota o se desplaza la articulación ¿, dependiendo 
de si es rotacional o prismática, es el eje z;. Por lo tanto, dada una articulación 
arbitraria, siempre existe una variable que se encuentra cambiando con respecto al 
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tiempo. Dicha variable se representa por 0; o di, dependiendo de si la articulación es 
rotacional o prismática, respectivamente. Dichas variables se denominan variables 
de articulación. 


Un concepto importante para el robot es el de grados de libertad (GDL). que 
se refieren al conjunto de variables independientes que permiten determinar la posi- 
ción y orientación del elemento final del robot. Los eslabones de un robot se mueven 
por medio de dispositivos denominados actuadores. Dichos actuadores pueden ser 
hidráulicos, neumáticos o eléctricos. Los actuadores se encuentran acoplados con las 
articulaciones del robot. Si las articulaciones son independientes, con una única direc- 
ción de movimiento o rotación respecto a un eje determinado, el número de articula- 
ciones con que cuenta un manipulador coincide con el número de grados de libertad 
del manipulador. Sin embargo, las articulaciones pueden tener más de un grado de 
libertad. En éste caso, el número de articulaciones será diferente al número de GDL 
del manipulador. Sin pérdida de generalidad, puede considerarse que el robot posee 
únicamente articulaciones de un grado de libertad, debido a que si alguna articulación 
cuenta con m-GDL, se le puede considerar como un conjunto de m articulaciones de 
1-GDL conectadas entre sí por eslabones con longitud nula. 

En la figura 1.1 se muestran algunos ejemplos de articulaciones [3]. Es común 
emplear la letra R para referirse a articulaciones rotacionales y P para las prismáticas. 
Otros tipos de articulaciones comunes son las cilíndricas con dos grados de libertad 
(2-GDL). planares con 2-GDL y esféricas con 3-GDL, mostradas también en la figura 


40 


(a) (b) 


P3 


(d) (e) 


Figura 1.1 Articulaciones comunes en robots manipuladores: (a) rotacional con 1-GDL; (b) cilindrica 
con 2-GDL; (c) esférica con 3-GDL; (d) prismática con 1-GDL; (e) planar con 2-GDL. 
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Si se requiere mover un cierto elemento a cualquier punto en el espacio, es posible 
hacerlo moviéndose a lo largo de los tres ejes x, y, z. Si además se quiere que dicho 
objeto tenga una orientación deseada, deberá de rotarse con respecto a cualquiera de 
dichos ejes. Por lo tanto, para que un robot pueda posicionarse en cualquier punto en 
el espacio con una orientación arbitraria, éste debe de poseer al menos seis GDL, ya 
que con un menor número de GDL el robot no podría alcanzar cualquier punto en el 
espacio con una orientación arbitraria. A los robots manipuladores con más de seis 
GDL se les denomina redundantes. 


La parte terminal del robot, donde normalmente se suele acoplar una cierta he- 
rramienta o dispositivo para realizar una tarea determinada, se denomina efector 
final. Al volumen total que es cubierto por el efector final cuando el robot efectúa 
cualquiera de sus movimientos posibles se le denomina espacio de trabajo. El es- 
pacio de trabajo del manipulador puede clasificarse de la siguiente manera: 


a Espacio de trabajo alcanzable. Se trata del conjunto de puntos que es capaz 
de alcanzar el robot. 


a Espacio de trabajo diestro. Son todos los puntos que es capaz de alcanzar 
el robot con una orientación arbitraria. 


Claramente todos los puntos del espacio de trabajo diestro se encuentran contenidos 
dentro del conjunto del espacio de trabajo alcanzable. 


Hasta este momento sólo se han mencionado los eslabones y articulaciones como 
elementos de un robot manipulador. Sin embargo, existen otros elementos que forman 
parte del sistema robótico. Entre estos elementos se encuentran: 


1. Sistema de potencia. Puede contener una fuente de alimentación y amplifi- 


cadores que permiten generar las señales requeridas por los actuadores. 


2. Efector final. Dependiendo de la tarea que tenga el robot, se pueden tener dis- 
tintos tipos de efectores finales. 


3. Sensores. Permiten medir distintas señales útiles para controlar al robot mani- 
pulador. 


4. Controlador. Normalmente se trata de un dispositivo computacional que realiza 
los cálculos para que el robot desarrolle las tareas para las que fue diseñado. 
El controlador normalmente recibe información de programas base, así como de 
sistemas de enseñanza, los cuales le permiten mejorar su desempeño. 


En la figura 1.2 se muestra una representación de los elementos indicados anterior- 
mente, para visualizar en conjunto al denominado sistema robótico [3]. 
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Sistema de 
enseñanza 


Sistema de 
ncia 


Figura 1.2 Diagrama de bloques de un sistema robótico. 


En las tareas realizadas por los robots manipuladores es importante clarificar el con- 
cepto de precisión, el cual proporciona una medida de la cercanía con que el mani- 
pulador regresa a una posición aprendida con anterioridad. Entre más preciso sea un 
robot mejor será su desempeño. 


El modelado de los robots manipuladores es importante debido a que al modelar 
se suelen hacer ciertas consideraciones que simplifican el sistema considerado. Sin em- 
bargo, éstas simplificaciones generan errores que tendrán un impacto en la precisión 
del robot. Por ejemplo, si se desprecian los efectos debidos a la fricción, el modelo del 
sistema no la incluirá, pero si el dispositivo opera dentro de un rango en el cual la 
fricción sea de interés, entonces la dinámica referente a la fricción comienza a intro- 
ducir errores que afectan el desempeño del sistema. Otro ejemplo puede observarse en 
sistemas eléctricos, ya que normalmente si se diseña un filtro Butterworth para pro- 
bar la teoría vista en una clase básica de comunicaciones, dichos filtros se diseñan con 
frecuencias de corte bajas, por ejemplo 10 kHz. En la construcción del filtro se suelen 
usar amplificadores operacionales básicos. Considerando aplicaciones más avanzadas, 
es normal que se requieran filtros operando en el rango de los Gigaherts. Si se di- 
señan dichos filtros con los mismos dispositivos electrónicos empleados en rangos de 
baja frecuencia, es seguro que el circuito no funcionará, ya que se presentarán efectos 
parásitos debidos a dinámicas no modeladas que afectarán de manera significativa el 
desempeño del sistema. 


Por otra parte, aún cuando se cuente con un buen modelo del robot, si no se cuenta 
con una estrategia o ley de control que opere de manera adecuada, se tendrán errores 
que repercutirán en mayor o menor medida en el desempeño del sistema robótico. 
En este punto es importante considerar que el término desempeño es bastante amplio 
y puede referirse a elementos tales como: tiempo de respuesta del sistema, error de 
seguimiento de una trayectoria determinada, repetitividad para volver a posiciones 
aprendidas previamente, etc. Por lo tanto, al modelar robots manipuladores es im- 
portante tener en cuenta la tarea que el robot llevará a cabo, de modo que el efecto 
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de los errores tenga un menor impacto y se obtenga así un mejor desempeño. 


1.3 Clasificación de manipuladores robóticos 


Existen muchas posibilidades para clasificar a los robots manipuladores. Por ejem- 
plo, la clasificación puede tomar en cuenta la aplicación del robot, el tipo de control 
empleado, la estructura cinemática del manipulador, o la geometría del robot [3]. 
Considerando el aspecto de geometría, las primeras tres articulaciones del robot que 
le brindan su posicionamiento, permiten clasificar al mismo como: manipuladores arti- 
culados o RRR, manipuladores RRP (esféricos o SCARA), manipuladores cilíndricos 
o RPP, y manipuladores cartesianos o PPP. Ejemplos de estas categorías se muestran 
a continuación. 


Manipuladores articulados o RRR 


Algunas veces se les denomina manipuladores rotacionales o antropomórficos. Las 
primeras tres articulaciones de estos manipuladores son rotacionales. Ejemplos de 
dichos manipuladores son el PUMA (ver figura 1.3) o el Cincinnati Milacron T” (ver 
figura 1.4). Una de sus ventajas es que permiten una amplia variedad de movimientos 
en espacios reducidos. 


Figura 1.3 Manipulador PUMA (Programmable Figura 1.4 Manipulador Cincinnati Milacron T? 
Universal Manipulator for Assembly). 735. 
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Manipuladores RRP 


Dentro de esta clasificación se encuentran los robots manipuladores esféricos. Su nom- 
bre se debe a que la posición del efector final se puede describir por medio de coorde- 
nadas esféricas. Un ejemplo de este tipo de robots es el manipulador Stanford que se 
representa en la figura 1.5. En estos manipuladores, las dos primeras articulaciones 
son rotacionales, mientras que la tercera es prismática. 

Una variación de estos robots manipuladores se obtiene empleando la configuración 
o arreglo SCARA (Selective Compliant Articulated Robot for Assembly). Un ejemplo 
de este tipo de robots se muestra en la figura 1.6. Una de sus aplicaciones principales 
es la de ensamblaje. 


Figura 1.5 Manipulador Stanford. 


Figura 1.6 Manipulador SCARA. 


Manipuladores cilíndricos o RPP 


Un ejemplo de la estructura de estos robots manipuladores se muestra en la figura 
1.7. Para estos robots, las variables de las articulaciones pueden expresarse a través 
de coordenadas cilíndricas del efector final referido a la base. La primera articulación 
de los mismos es rotacional, mientras que las dos siguientes son prismáticas. 
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Figura 1.7 Manipulador cilíndrico. 


Manipuladores cartesianos o PPP 


En estos robots manipuladores, las variables de las articulaciones pueden manejarse 
mediante coordenadas cartesianas para referir el efector final con respecto a su base. 
Las primeras tres articulaciones de los mismos son prismáticas. Entre sus aplicaciones 
se encuentran el ensamblado y transferencia de material. Un ejemplo de la estructura 
de éste tipo de robot se muestra en la figura 1.8. 


Ss 


Figura 1.8 Manipulador cartesiano. 
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1.4 Componentes finales de un manipulador 


Una vez que se tiene una estructura específica de un manipulador, es importante 
considerar el elemento que permitirá el movimiento del efector final. En este punto es 
común encontrar la denominada muñeca esférica, como la mostrada en la figura 1.9 [3]. 
La muñeca esférica posee tres GDL y permite al robot proporcionar una orientación 
deseada a un objeto manipulado. Este dispositivo favorece las capacidades de un 
robot, permitiéndolo realizar con precisión las tareas deseadas. 


A 
G 


Z 
(a) (h) 


Figura 1.9 Muñeca esférica: (a) posible representación real; (b) representación esquemática. 


Después de la muñeca esférica se puede tener un efector final para realizar las tareas 
por el robot manipulador. Un ejemplo de efector final es una tenaza, la cual normal- 
mente realiza dos tareas: abrir y cerrar. Para tareas más complejas pueden emplearse 
dispositivos más sofisticados como una mano mecánica antropomórfica, aunque dichos 
elementos son mucho más complicados para controlar y son un tema de gran interés 
en el campo de la investigación en robótica. 


1.5 Resumen 


En este Capítulo se realizó el estudio de los antecedentes de la robótica, presentando 
un panorama de su evolución. La tecnología ha sido un factor determinante para que 
esta disciplina evolucione y se convierta en un tema preponderante en la actualidad. 


Otro aspecto importante analizado en este Capítulo es el referente a los elementos 
que constituyen un robot manipulador, es decir, los eslabones y las articulaciones. Es- 
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tos elementos serán de gran importancia cuando se trate el tema de análisis cinemático 
y dinámico de los robots manipuladores. Además, se incluyó el concepto de sistema 
robótico general, mostrando los elementos necesarios para ponerlo en operación. 


Algunos ejemplos de robots manipuladores, empleando la clasificación geométrica, 
fueron proporcionados, así como la inclusión del concepto de muñeca esférica y efec- 
tor final. Todos estos conceptos son necesarios para entender la forma en que debe 
estructurarse un sistema robótico. 


En este texto se abordarán los aspectos principales del análisis de manipuladores 
robóticos. Dichos temas permitirán forjar las bases para el estudio del control de los 
mismos. Los temas que se abordarán en adelante son los siguientes: 


Capítulo 2. En este capítulo se comenzará el estudio de los denominados operadores 
cinemáticos, por lo que será la primera aproximación antes de comenzar for- 
malmente con el estudio de la cinemática directa. Los temas principales que 
se abordan son: matrices de rotación, matrices de transformación homogénea, 
parametrizaciones de matrices de rotación y diversas aplicaciones de las matrices 
de transformación homogénea. 


Capítulo 3. Se trata el análisis de la cinemática directa de un robot manipulador, 
empleando la convención de Denavit-Hartenberg. Se estudian los aspectos que 
permiten determinar la posición del efector final a través de los valores de las 
variables de las articulaciones. Esta parte del texto es importante porque pre- 
senta una gran cantidad de definiciones y explicaciones que son fundamentales 
en el estudio de la dinámica de los robots. Como se verá, básicamente se trata 
de aplicaciones de conceptos de álgebra lineal, por lo que es importante estudiar 
los conceptos que se presentan a manera de resumen en el Apéndice A. 


Capítulo 4. Se estudia el Jacobiano del manipulador, uno de los temas más impor- 
tantes tratados en éste texto. El estudio del Jacobiano es importante dado que 
puede emplearse para el cálculo de las ecuaciones dinámicas del robot, las cuales 
pueden utilizarse a su vez para realizar el control de los robots manipuladores. 
Se analiza en gran detalle el cálculo del Jacobiano y las interpretaciones que 
se le pueden dar, de modo que al terminar el estudio de esta Unidad el lector 
será capaz de comenzar el estudio de la dinámica de los robots manipuladores. 
Además, se presenta una metodología de control para seguimiento de trayecto- 
rias, empleando la cinemática directa y el Jacobiano del manipulador. 


Capítulo 5. Finalmente, una vez que se han adquirido los conocimientos básicos 
de cinemática del manipulador y Jacobiano, el siguiente paso es determinar la 
forma de aplicar dicha información para poder llevar a cabo el modelado de 
un robot manipulador. Esta unidad contiene una gran cantidad de información 
debido a que se estudia el modelado de los robots manipuladores empleando el 
formalismo de Newton-Euler (NE) y las ecuaciones de Euler-Lagrange (EL). En 
el caso de las ecuaciones EL, se presentan una serie de ejemplos por medio de los 
cuales se puede visualizar su uso. También se muestran ejemplos para obtener 
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las ecuaciones dinámicas de robots manipuladores. Además, se presentan apli- 
caciones adicionales que incluyen un robot de articulaciones flexibles y circuitos 
eléctricos. 


Los temas anteriores son suficientes para tener una base sólida del análisis cinemático 
y dinámico de manipuladores robóticos, antes de comenzar con un tema de control. 
El lector debe de ser capaz de comprender el verdadero significado de los conceptos 
manejados a lo largo del texto, de modo que no solo pueda realizar los cálculos que 
se indican, sino que también los sepa interpretar de manera adecuada, ya que de ello 
dependerá que sus modelos posteriores sean correctos. 


1.1 Indique por definición cuáles son las características fundamentales que distinguen 
a un robot manipulador. 


1.2 Indique a partir de qué tecnologías puede considerarse el surgimiento de los robots. 
1.3 ¡Cuáles son los elementos fundamentales que constituyen a un robot manipulador? 


1.4 ¡Cuáles son los tipos de cadenas cinemáticas que pueden distinguirse en un robot 
manipulador? 


1.5 ¿Cuándo se dice que un robot tiene cadena cinemática abierta? 


1.6 De modo general, ¿cuáles son los dos tipos de articulaciones que pueden constituir 
a un robot manipulador? 


1.7 ¿Qué es una variable de articulación? 


1.8 ¿Por qué, a pesar de que pueden existir articulaciones de más de un grado de 
libertad, el análisis para los robots manipuladores se lleva a cabo considerando arti- 
culaciones de 1 GDL? 


1.9 Indique qué es el efector final en un robot manipulador. 


1.10 ¿Qué es el espacio de trabajo y cómo puede clasificarse? 
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1.11 ¿Cuándo se dice que un robot manipulador es redundante? 


1.12 Construya un diagrama a bloques donde se muestren de modo general los ele- 
mentos que constituyen a un sistema robótico e indique la función de cada elemento. 


1.13 Considerando la geometría del robot manipulador como aspecto de interés, ¿cuál 
sería una posible clasificación de los mismos? 
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La ciencia son hechos; de la misma manera que las casas están 
hechas de piedras, la ciencia está hecha de hechos, pero un 
montón de piedras no es una casa y una colección de hechos 
no es necesariamente una ciencia. 


Henri Poincaré 


Cuando se estudia el movimiento de los robots es importante tener en cuenta que los 
mismos realizan movimientos de rotación y traslación y que dichos movimientos se 
describirán de manera adecuada siempre que se mantenga un orden determinado, el 
cual puede establecerse mediante una asignación ordenada de un conjunto de sistemas 
de coordenadas para cada uno de los eslabones del manipulador, y estableciendo la 
relación que existe a través de dichos sistemas de coordenadas. 

En este capítulo se establecerá dicho orden entre los sistemas de referencia a través 
de elementos tales como: matrices de rotación y transformaciones homogéneas. Se es- 
tudiarán a detalle las propiedades de dichas matrices, y se analizarán las parametriza- 
ciones de las matrices de rotación y las interpretaciones de las mismas, así como de 
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las matrices de transformación homogénea. Estos dos tipos de matrices serán am- 
pliamente usadas cuando se trate el estudio de la cinemática directa de un robot 
manipulador empleando la convención de Denavit-Hartenberg en el Capítulo 3, y 
para el cálculo del Jacobiano del manipulador en el Capítulo 4. 


2.2 Conceptos cinemáticos básicos 


Cuando se requiere que un robot lleve a cabo una tarea determinada normalmente se 
tiene interés en el conjunto de puntos a lo largo de los cuales se moverá su efector final. 
Refiriéndose a alguno de dichos puntos, considérese la figura 2.1, donde se muestra 
el punto arbitrario p, el cual se encuentra en un cierto lugar en el espacio y se puede 
ubicar por medio de una amplia variedad de formas. 


Si se considera un sistema de coordenadas cartesianas y se quiere hacer referencia 
al punto p, entonces se debe de asignar un sistema de referencia como los sistemas de 
referencia (0) y {1} mostrados en la figura 2.1*. El punto p puede referenciarse con res- 
pecto a cualquiera de dichos sistemas de coordenadas, y se puede usar un superíndice 
para indicar con respecto a cuál sistema de coordenadas se está referenciando. Por 
ejemplo, p° indica la ubicación del punto p con respecto al sistema de coordenadas 


fo”. 


Figura 2.1 Representación de un punto p en el espacio con respecto a dos sistemas de coordenadas. 


El elemento p es simplemente una entidad geométrica, mientras que p° representa un 


De ahora en adelante, cuando se hable de un sistema de referencia se deberá de entender un 
sistema constituido por los ejes x, y, z, junto con su origen o. Un ¿-ésimo sistema de referencia se 
representará empleando la notación {£;, Yi, Zi, 0i}, o de modo compacto {i}. 

2Nótese el uso de letras en negritas para designar al vector p, y diferenciarlo del punto p. 
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vector. La diferencia de estos dos elementos es que p no depende de los sistemas de 
coordenadas, mientras que el vector p° sí, ya que depende de {0}. Debido a que p? 
es un vector, posee las propiedades usuales de magnitud, dirección y sentido. 


Cuando se manejan vectores, se pueden considerar los denominados vectores libres, 
los cuales estan caracterizados por su magnitud, dirección y sentido, independiente- 
mente del lugar en que se encuentren. Por lo tanto, dos vectores p y q serán iguales 
siempre que su magnitud, sentido y dirección sean iguales. De ahora en adelante se 
tratará a los vectores como vectores libres. 


Para realizar operaciones con vectores se requiere que éstos se encuentren expre- 
sados con respecto al mismo sistema de referencia, o que los sistemas de coordenadas 
sean paralelos, es decir, que sus ejes respectivos sean paralelos. 


Supóngase que se tiene un conjunto de sistemas de referencia con orígenes no 
coincidentes y diferente orientación entre sí. Si se tienen distintos vectores y cada uno 
se expresa con respecto a un sistema de referencia distinto, es posible llevar a cabo 
operaciones entre ellos siempre que todos se expresen con respecto a un sistema de 
referencia común, lo cual se efectúa empleando: 


a Matrices de rotación cuando los sistemas de referencia sólo difieren en su o- 
rientación. 


a Matrices de transformación homogénea cuando los sistemas de referencia difieren 
tanto en la posición de su origen como en su orientación relativa. 


De esta manera, supóngase que se tienen los sistemas de referencia {A} y {B}, los 
cuales no son paralelos y tienen distinta orientación. Empleando estos sistemas de 
referencia se obtienen los siguientes vectores: p^, q^ y r”. De acuerdo a lo indicado 
anteriormente, las operaciones con vectores deben hacerse empleando el mismo sistema 
de referencia, por lo que es incorrecto considerar la suma p* + r”, mientras que sí 
es correcto considerar la suma p^ + q^. Éste ejemplo indica la importancia de poder 
transformar la representación de un vector de un sistema de coordenadas a otro, de 
modo que las operaciones que se vayan a realizar con los mismos estén bien definidas. 


2.3 Matrices de rotación 


El análisis que se desarrollará a continuación emplea los conceptos de componente 
de un vector sobre un eje determinado y producto punto, por lo que se recomienda 
leer dichos conceptos en el Apéndice A para comprender apropiadamente el desarrollo 
siguiente. 


En la figura 2.2 se muestran los sistemas de coordenadas (0) y (1). Los orígenes 
de éstos sistemas de referencia coinciden, pero su orientación es diferente. De la figura 
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se observan las siguientes propiedades: 


a Los orígenes de los sistemas de referencia coinciden. 
a Los ejes Zo y zı son coincidentes. 


a Los ejes X, yı presentan una rotación en un ángulo ð con respecto a los ejes 
Xp. yo- 


Figura 2.2 Sistemas de coordenadas con orígenes coincidentes en dos dimensiones. 


En la figura 2.2, el sistema de referencia (1) se obtuvo al rotar con respecto al eje Zo 
un ángulo? 0. 


Lo que se busca ahora es la representación de la orientación del sistema de re- 
ferencia (1) con respecto a {0}, lo cual se puede obtener empleando el ángulo 0 que 
los diferencía. De esta manera, sean Xp, Yo y X1.y1 los vectores unitarios base* co- 
rrespondientes a los sistemas de coordenadas {0} y (1) respectivamente, y sea x? la 
representación de xı con respecto al sistema de coordenadas (0). 


El vector x? representa la orientación que tiene el vector xı con respecto al sistema 
de referencia {0}. Para poder determinar este vector lo único que debe hacerse es 


3Cuando se indique una rotación en un sistema de coordenadas, el valor positivo del ángulo de 
rotación se determinará por medio de la regla de la mano derecha, es decir, en sentido contrario a 
las manecillas del reloj. 

1Normalmente los vectores unitarios base se representan por i y j. En este caso, dado que se 
manejan varios sistemas de coordenadas, para un sistema de coordenadas {i} se considerarán los 
vectores unitarios base como Xi, yi y Zi. En el ejemplo que se está considerando en este momento 
sólo se emplean dos dimensiones, por lo que no se hace uso del vector z;. En la figura 2.2 se emplean 
los vectores unitarios base xo, Yo, Zo Y X1.y1,Z1 para indicar la dirección de los ejes correspondientes 
para cada sistema de referencia. 
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encontrar sus componentes a lo largo del eje x e y del sistema (0). Por ejemplo, 
en la figura 2.3 las componentes de x, en el sistema de referencia (0) son a; y az, 
mientras que las componentes de y, en {0} son bı y bz. Por lo tanto, se obtienen las 
representaciones x? = [a], az]? y y? = [—b1, b2]”. 


Figura 2.3 Identificación de los componentes de un vector. 


De la figura 2.3 es posible observar lo siguiente: 


a La componente del vector x, en el eje x del sistema (0) es a, = [[x1]| cos 8. 
a La componente del vector x, en el eje y del sistema (0) es az = [[x1 || sen 8. 


a La componente del vector y, en el eje x del sistema {0} es —b, = l|ly1 || cos (0 + 90) = 
- Jiya] sen 6. 


a La componente del vector y; en el eje y del sistema {0} es ba = |ly1 || sen (0 + 90) = 
lly1 [| cos8. 


Debido a que xı e y, son vectores unitarios (i.e., tienen magnitud unitaria), es claro 
que ||xı|| = lly1 [| = 1, por lo que es posible concluir que la componente del vector yı 
en el eje x del sistema {0} es —b, = —sen Ó y su componente en el eje y del sistema 
{0} es bọ = cos0. El mismo análisis puede hacerse con x, y entonces se obtiene el 
siguiente resultado: 


S” a cos 0 o_ | cos(0 + 90°) | _ | —sen 8 
e Y1 = | sen (0 +90°) | | cos8 


Empleando el resultado anterior es posible construir la matriz: 
Ono M0 0 
Ri = [x1, y1] 
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En este punto es importante recordar lo siguiente: 


a El vector x? representa la orientación del eje x del sistema de referencia (1) con 
respecto al sistema de referencia (0). 


a El vector y? representa la orientación del eje y del sistema de referencia (1) con 
respecto al sistema de referencia (0). 


Debido a lo anterior, la matriz R? sirve para representar la orientación de los vec- 
tores base del sistema de referencia (1) con respecto al sistema de referencia {0} y 
dicha matriz se denomina matriz de rotación. De esta manera, para el ejemplo 
considerado, la matriz de rotación que relaciona a los sistemas de referencia {0} y (1) 
es: 


R? = [x},y?] = 


cos —sen 0 
sen cos 


Las columnas de la matriz de rotación Rf indican la orientación de los vectores uni- 
tarios x e y del sistema (1) expresados de manera relativa al sistema de coordenadas 
{0}. Es importante tener en cuenta que las matrices de rotación de dimensión 3 x 3 
pertenecen al denominado grupo especial ortogonal de orden 3 o SO(3) [2]. 


Una manera más conveniente para construir la matriz de rotación es recordar 
algunos aspectos de álgebra lineal. En este caso, dados dos vectores unitarios a y 
b, el producto punto entre ambos, representado por (a,b), indica la componente de 
un vector en la dirección del otro vector. Además, el producto punto proporciona el 
ángulo que existe entre ambos vectores. Por ejemplo, dados los vectores a y b, su 
producto punto puede escribirse como: 


a- b = (a,b) = llal| ||b|| cos a 


donde a es el ángulo que existe entre dichos vectores. Por lo tanto, si a y b son 
unitarios, el producto punto se reduce a (a,b) = cosa. Si se relaciona este concepto 
de producto punto con los vectores xf, y9, es posible obtener las siguientes expresiones: 


xo = l cos 0 | E l lix l| llxo]] cos € | S | (x1, Xo) | 
i sen O lIxxx [| [ly o(] cos (90 — 0) (xı; yo) 


o [ 20]. [ ao = | Sew ] 
cos 0 Ilya! lyol] cos 0 (y1.yo0) 


por lo que la matriz de rotación R se puede expresar como: 


R? = l (x1,X0) (Y1,Xo) 
1 | (X1,yo) (y1.yo0) 
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En este caso, las columnas de la matriz de rotación representan los denominados 
cosenos directores de los ejes coordenados del sistema (1) relativos al sistema (0), 
debido a que el producto punto de ambos vectores se convierte en el ángulo entre 
ellos. Por ejemplo, la primera columna de R? indica la orientación de x; relativa al 
sistema {0} y la segunda columna indica la orientación de y, relativa al sistema (0). 
En conclusión, la matriz de rotación Rf sirve para expresar la orientación del sistema 
de referencia {1} con respecto a (0). 


Siguiendo la lógica del análisis previo, es posible concluir que la matriz R} repre- 
senta la orientación del sistema de referencia (0) con respecto a (1), por lo que su 
primera columna indicará la orientación del eje Xo con respecto a (1) y la segunda 
columna la orientación de yo con respecto a {1}. Por lo tanto, dicha matriz se puede 
expresar como: 


R! | (Xo,X1) a] 
A (Xo.Y1) (Yo»y1) 


y, aplicando la propiedad de conmutatividad del producto punto que indica que 
(a, b) = (b,a), se obtiene: 


1_ | (X1,Xx0) (X1,Y0) | _ fpoj7 
a | (y1,Xo0) (Yoyo) | [a] 


Para comprender el resultado anterior es importante considerar nuevamente la figura 
2.2. En este caso la orientación de {0} respecto a {1} corresponde a la inversa de la 
orientación de {1} respecto a {0}. Es decir, si (1) se obtuvo al rotar el sistema (0) 
con respecto al eje Zo un ángulo 0, entonces {0} se obtiene al rotar {1} con respecto al 
eje zı un ángulo —6. Por lo tanto, la matriz R} representa el proceso inverso descrito 
por RI, es decir: 


Ri = [R] = [R]" 


ambién debe observarse que las columnas de ienen magnitud unitaria y son 
Tamb debe ot que l l de R? t tud t 


V 


mutuamente ortogonales, es decir, la matriz de rotación es una matriz ortogonal [4]. 
Otra propiedad importante de las matrices de rotación es que cumplen la siguiente 
igualdad: 


det (R) = +1 


debido a que: 


RRT =I 


por lo tanto 
det I = det (RRT) = det R det RT = (det R)? = 1 
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y el resultado se sigue”. 


Usando los cosenos directores se puede obtener la matriz de rotación para el caso 
tridimensional. Dados los sistemas (0) y {1}, se tiene: 


(x1,Xo0) (y1.X0) (Z1,Xo) 
RÌ = | (x1,y0) (y1,yo) (Z1,yo) (2.1) 
(x1,Z0) (y1.Zo) (Z1,Z0) 


Ahora considérese la figura 2.4. Dado el sistema de referencia (1), sea un punto p que 
se representa en dicho sistema de referencia como p} y que consta de las siguientes 
componentes: 


p’ = aXı + byı + cz: 


donde X1,y1,Z1 son los vectores unitarios base del sistema de referencia {1}. En- 
tonces, el vector pè puede expresarse en el sistema de coordenadas {0} simplemente 
obteniendo sus componentes con respecto a los ejes del sistema de coordenadas (0), 
es decir: 


R | (p*, xo) ] 


E ivi 
O | 


y desarrollando la expresión anterior se obtiene: 


| (p*. xo) ] | (axı + by1 + cz1.Xp) 
o = ( ) | = į (axı + by, + cz1. yo) 
( ) ] | (axı + byı + cZ1, Zo) ] 


(axı; yo) + (dy1, Y0) + (cZ1, yo) 

(axı, Zo) + (by1, Z0) + (cz1,Z0) 

(xı;Xo) (Y1;X0) (Z1,Xo0) 

(X1,Y0) (Y1-Yo) (21,Y0) 

(x1.Z0) (y1.Zo) (Z1,Zo) 
Rip! 


(axı, X0) + (by1, X0) + (cZ1,X0) | 
a 
b 
c 


5En el desarrollo anterior se emplearon los siguientes hechos: (a) Dada la matriz A € R"*”, 
entonces det (A) = det (AD); (b) Dadas las matrices (A, B}, entonces det (AB) = det (A) - det (B). 
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lo que indica que la matriz de rotación RÌ, además de indicar la orientación de un sis- 
tema de coordenadas con respecto al otro, sirve para transformar un vector expresado 
en un sistema de coordenadas a otro sistema de coordenadas. 


Figura 2.4 Transformación de la representación de un vector empleando matrices de rotación. 


Ejemplo 2.1 


Es importante notar la simplicidad y verdadero significado de la matriz de rotación. 
Considérese el sistema de referencia {0} y el sistema de referencia (1) que se obtiene 
al rotar (0) con respecto al eje zy un ángulo de 0. En este ejemplo se supone que 
0 = 45°, como se indica en la figura 2.5. 

La matriz de rotación que relaciona cualquier elemento del sistema de referencia 
{1} con el sistema de referencia {0} está dada por la ecuación (2.1). Para este ejemplo 
se pueden calcular dichos elementos de modo sencillo como se indica a continuación: 


| (x1.Xx0) (y1.Xo0) (Z1.Xo) cos —sen9 0 ] 
R} = | (X1.y0) (y1.yo) (Z1,yo) | = ¡ send cosð 0 
| (x1,Z0) (y1.Zo) (Z1,Zo) ] | 0 0 1 ] 
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Figura 2.5 Sistemas de referencia rotados un ángulo ð con respecto al eje z. 


Supóngase que se tiene el vector p? = (3, 3.0)”. Se observa de la figura que p? se 
encuentra posicionado a lo largo del eje yo. y su magnitud es de VIS. Si se quiere 
obtener dicho vector expresado en el sistema de referencia (0) es de esperarse que 
dicho vector se convierta en (0, VT8, 0), lo cual se demostrará empleando la matriz de 
rotación obtenida anteriormente. Para ello es importante recordar que la matriz de 
rotación sirve para representar un vector con respecto a otro sistema de coordenadas, 
por lo que para transformar al vector p’ en su equivalente expresado en el sistema 
de coordenadas {0}, es decir, en el vector p°, se tiene que premultiplicar dicho vector 
por la matriz de rotación Rf. Considerando 0 = 45° = 7/4 radianes, se obtiene: 


at na o a MAFA 
da e A TE 


que es el resultado esperado. De esta manera se muestra el uso y significado de las 
matrices de rotación. Es importante entender el concepto manejado en este ejemplo, 
ya que muchas de las manipulaciones que se trabajarán en adelante se basan en la 
comprensión de este concepto. 


- Ejemplo 2.2 


Otra posible interpretación de las matrices de rotación es la siguiente. Supóngase que 
se tiene un único sistema de coordenadas y el vector [3, 0, Ys Claramente dicho vector 
se encuentra en el plano xz con un ángulo de 45° ubicado en una arista del primer 
octante. Supóngase ahora que se toma dicho vector y se rota un ángulo de 90% con 
respecto al eje z. En este caso, intuitivamente se concluye que el vector resultante 
será [0, 3, 37 Este resultado puede obtenerse si se premultiplica el vector inicial por 
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la matriz de rotación Raz como se muestra a continuación”: 


sí —-snf 0 3 0 
ap ær ol fel-fel 


lo cual sirve para mostrar una interpretación más de la matriz de rotación: su apli- 
cación permite rotar un vector un ángulo 0 en el mismo sistema de coordenadas. 


Como puede apreciarse, la interpretación que se le atribuya a la matriz de rotación 
puede ser variada y debe tenerse cuidado en cada caso del enfoque considerado para 
comprender el resultado obtenido. 


2.3.1 Matrices de rotación básicas 


Es importante distinguir tres matrices de rotación que se consideran básicas. Lo an- 
terior se debe a que dichas matrices son las que se obtienen cuando un sistema de 
coordenadas se rota con respecto a cualquiera de sus ejes principales, es decir, los 
ejes x,y,z. Para simplificar la presentación de resultados se empleará la notación si- 
guiente: si la rotación se hace con respecto al eje z un ángulo 0, se representará dicha 
matriz mediante Rz.. De esta manera, las matrices de rotación básicas son: 


1 0 0 

Rxo= ¡| 0 cos —sen 0 
O send cos 

cosó 0 seng 

0 1 0 (2.2) 

-sen ð 0 cos 
cos —senð 0 
Rao = | senó coso 0 | 


pro] 
> 
© 

Il 


0 0 1 


En general las matrices de rotación poseen las siguientes propiedades importantes (se 
indica la propiedad para la rotación con respecto al eje x, pero lo mismo es válido 
para cualquier eje): 


Nótese que en este caso se emplea la notación Ra, ¿ Para indicar la operación de rotación con 
DA 


respecto al eje z un ángulo de $. 
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Rx,0 =I 
Rx.aRx,8 = Rxa+8 
LA = Rx,-a 


_Ejemplo 23 


Se tienen dos sistemas de referencia (A) y {B} como se indica en la figura 2.6, donde 
{B} se obtiene a partir de la rotación de {A} con respecto al eje z4 un ángulo de 30? 


(7/6 radianes). La expresión para la matriz de rotación que relaciona ambos sistemas 
de referencia es: 


A 
Rg = Rz30= 


(xB, Xa) (Y B,Xa) (Zp,xa) 
(xB.Ya) (YB.Y a) (ZB,ya) 
(x8,ZaA) (YsB:Z4) (ZpB,Za) 


cos? —senf 0 
= sen 7 cos Ẹ 0 
0 0 1 
Y3 1 
E: Y o ] 
= 1 3 
2z 70 
0 0 1 


Ahora se buscará obtener la representación del vector p* en el sistema de referencia 


{A}. Para ello simplemente se premultiplica el vector p? por Rf como se indica a 
continuación: 


O E A A 
da E E 


y se observa el resultado obtenido en la figura 2.6. 
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Figura 2.6 Ejemplo de cambio de sistema de referencia. 


En el ejemplo anterior se empleó la notación RE para expresar a la matriz de rotación 
que transforma un vector de su representación en {B} a su representación en (A). 


2.3.2 Transformaciones de similaridad 


En algunos cálculos que se realizarán más adelante se requerirá el empleo de las 
denominadas transformaciones de similaridad. Por definición, dos matrices A y B son 
semejantes (ver Apéndice A) si existe una matriz invertible C tal que: 


B=C"*%AC 


Para expresar un sistema de referencia con respecto a otro, en general debe propor- 
cionarse la información no solo de su orientación relativa, sino también de la posición 
de su origen. Además, un sistema de referencia puede caracterizarse por medio de sus 
vectores base. 


Considerando dos sistemas de referencia, la matriz de rotación que los relaciona 
puede interpretarse como una matriz de cambio de base de un sistema de referencia a 
otro, y la matriz de rotación es de hecho la matriz de cambio de base. De esta manera, 
si la matriz A! es la representación de una transformación lineal en el sistema de 
coordenadas {1} y se quiere obtener la representación de dicha transformación en el 
sistema (0), la matriz C que se requiere es la matriz de cambio de base, que en este 
caso es Rf, por lo tanto: 


A? = RA! [RO =RA! [R9* (2.3) 


De esta manera, cuando se tiene una matriz expresada en un sistema de referencia 
{1} y se requiere expresarla en un sistema de referencia {0}, se debe emplear la 
transformación de similaridad descrita en la ecuación (2.3). 
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2.3.3 Composición de rotaciones 


Las matrices de rotación pueden mezclarse o componerse de manera sencilla una vez 
que se ha entendido la interpretación de la transformación de un vector de un sistema 
de coordenadas a otro empleando matrices de rotación. Para verificar esto supóngase 
que se tienen los sistemas de coordenadas (0), {1}, (2) y {3}, y se tiene el punto 
p representado en cada uno de dichos sistemas de coordenadas. Sean las matrices 
de rotación Rf], R} y Rí3 que relacionan a los sistemas de coordenadas {0} con (1), 
{1} con {2} y {2} con {3}, respectivamente. Los vectores que representan al punto p 
pueden escribirse de la siguiente manera: 


pP = Rip 
p! = Rp? 
p? = Rip" 


por lo que es sencillo verificar que: 


p° = Rip’ = Ri Rip? = RiR R3p” 
pero, dados los sistemas {0} y {3}, debe de existir una matriz R3 que los relacione, 
es decir, dado el punto p, se debe cumplir la siguiente relación: 
0 0,3 
p = R3p 


entonces: 


p° = R3p” = R) R,}R3p” 


de donde se obtiene la relación: 


0 — pop! p2 
R3 = Ri R2R3 


que indica que la matrices de rotación pueden combinarse entre sí para obtener una 
nueva matriz de rotación que sea equivalente a todas las rotaciones realizadas. En 
este caso, la matriz de rotación RÌ relaciona el sistema de coordenadas {3} con el 
sistema de coordenadas (0). De la relación mostrada se observa que RÌ se obtiene 
al multiplicar hacia la derecha las matrices RI, R} y R3. Por lo tanto, la operación 
representada por RÌ equivale a las siguientes acciones: 


1. Inicialmente se tiene el sistema de referencia (0). Luego el sistema (1) se obtiene 


por medio de una rotación con respecto a algún eje del sistema de referencia 
{0} de acuerdo a Rf. 
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2. El sistema de referencia (2) se obtiene de una rotación con respecto a algún 
eje del sistema de referencia {1} de acuerdo a R}, sin embargo, también puede 
obtenerse por medio de una rotación con respecto a algún eje del sistema de 
referencia {0} de acuerdo a la matriz de rotación Rf. 


3. El sistema de referencia (3) se obtiene de una rotación con respecto a algún 
eje del sistema de referencia {2} de acuerdo a R?, sin embargo, también puede 
obtenerse por medio de una rotación con respecto a algún eje del sistema de 
referencia (0) de acuerdo a la matriz de rotación R3. 


En los pasos descritos anteriormente se debe notar que cada una de las rotaciones se 
realiza con respecto al sistema de coordenadas actual, el cual es un punto importante 
que se verá en la siguiente sección, en donde se indicará cómo se pueden efectuar un 
conjunto de rotaciones pero con respecto a un cierto sistema de coordenadas absoluto 
o fijo. 

De modo general, dados n sistemas de coordenadas, la composición de rotaciones 
puede expresarse de la siguiente manera: 


R? = RÌR} RE (2.4) 


En conclusión, si se llevan a cabo un conjunto de rotaciones con respecto a los ejes 
actuales, la matriz de rotación resultante se obtiene mediante la post-multiplicación 
de cada una de las matrices de rotación individuales, como lo indica (2.4). 


2.3.4 Rotaciones con respecto a ejes absolutos 


Todas las rotaciones descritas anteriormente se llevan a cabo con respecto a los ejes 
actuales. Sin embargo, de manera intuitiva es natural comprender que, se tienen los 
sistemas de referencia {0}, {1}, {2}, si se toma como sistema inicial a {0} y se realiza 
una rotación inicial con respecto al eje yy un ángulo 0 (obteniendo así el sistema {1}), 
y luego se hace una rotación con respecto a alguno de los ejes del nuevo sistema de 
referencia (sistema (1)), como por ejemplo el eje zı un ángulo ó, el resultado será 
Ry, o Rz, (y se obtiene el sistema de referencia (2)). Este resultado será diferente 
si se realiza el producto de las matrices de rotación en sentido contrario debido a 
que, de modo general, el producto de matrices no es conmutativo. Sin embargo, el 
producto en sentido contrario es de importancia como se muestra a continuación. 


Nótese del ejemplo que se está tratando que Ry, y es la matriz que relaciona los 
sistemas de coordenadas {0} y {1}, por lo que tomando en cuenta el resultado con- 
cerniente a las transformaciones de similaridad, considérese la rotación con respecto 
al eje absoluto zo dada por Rz,, ¿. Dicha matriz puede ser expresada en el sistema de 
coordenadas (1) de la siguiente manera: 
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[Ryo 0) Ti Rzo,6 Ryo K 


Si se considera la rotación con respecto al eje absoluto yo: Ry, seguida por la rotación 
con respecto al eje absoluto Zo: Rz., se puede concluir que la composición de dichas 
rotaciones puede obtenerse como si se tratara de rotaciones con respecto a los ejes 
actuales empleando la expresión anterior, i.e.: 


[Ry,.o] [(Ry,.0)7 Rao o Ryo] = Rz, Ryo.0 


por lo que se llega a las siguientes conclusiones: 


a Para obtener la matriz de rotación equivalente a realizar un conjunto de rota- 
ciones con respecto a los ejes actuales, se deben post-multiplicar todas las ma- 
trices de rotación correspondientes. 


a Para obtener la matriz de rotación equivalente a realizar un conjunto de rota- 
ciones con respecto a los ejes absolutos, se deben pre-multiplicar todas las ma- 
trices de rotación correspondientes. 


_ Ejemplo 2.4 


Supóngase que se realiza una rotación con respecto al eje z actual en un ángulo ð, 
seguida por una rotación con respecto al eje y actual un ángulo 6, seguida por una 
rotación con respecto al eje x actual un ángulo $. La matriz de rotación resultante 
es: 


R = Rz, Ry, Rx,8 


Ejemplo 2.5 


Supóngase que se realiza una rotación con respecto al eje z actual en un ángulo ð, 
seguida por una rotación con respecto al eje y absoluto un ángulo ó, seguida por una 
rotación con respecto al eje x absoluto un ángulo 3. La matriz de rotación resultante 
es: 


R= Rx.g Ry ¿KRz.0 
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RR | 


Supóngase que se realiza una rotación con respecto al eje z actual en un ángulo 0, 
seguida por una rotación con respecto al eje y absoluto un ángulo ġ, seguida por una 
rotación con respecto al eje x actual un ángulo 8. La matriz de rotación resultante 
es: 


R= Ry. Rz.0 Rx.8 


Las matrices de rotación también se denominan matrices ortonormales propias 


cuando su determinante es det (R) = +1, e impropias en caso contrario (det R = —1). 
Para cada matriz ortonormal R existe una matriz antisimétrica S (S = — S7) tal que 
[1]: 


R= |I- SJ? [I +5] 


La matriz S € IR* consta únicamente de tres parámetros diferentes, por lo que se 
puede representar por medio de un vector v = (T, y, z)” de la siguiente manera: 


: 0 -z y 
S(v)= S, = z 0 -=r 
-y 2 0 


es decir, toda matriz de rotación puede parametrizarse empleando únicamente 3 ele- 
mentos y no los nueve elementos que la conforman. Considérese la siguiente estructura 
para una matriz de rotación arbitraria: 


mL a Ta 
= tar Fea: Tag 
| T31 T32 T33 | 


Anteriormente se analizaron dos propiedades de las matrices de rotación: 


1. La norma de sus vectores columna es unitaria. 


2. Sus columnas son mutuamente ortogonales. 
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Empleando las propiedades anteriores se obtienen las siguientes expresiones: 


Y r} =1,i=1,2,3,j = 1,2,3 


TuiTij + T2iT2j + Tara =0,1 A j 


donde r;j denota el elemento ij de la matriz R. Por lo tanto, se obtiene un conjunto 
de 6 ecuaciones diferentes con 9 incógnitas, lo que lleva de nuevo a la conclusión 
de que las matrices de rotación pueden especificarse mediante 3 parámetros. Las 
representaciones de este tipo se conocen como representaciones mínimas, y permiten 
expresar la orientación relativa de un sistema de coordenadas {i} con respecto a un 
sistema de coordenadas {j} empleando un vector que contiene en general tres ángulos. 
A continuación se muestran algunas formas posibles en que se pueden asignar los tres 
parámetros libres para representar las matrices de rotación. 


2.4.1 Representación Roll-Pitch-Yaw (RPY) 


La representación Roll-Pitch-Yaw (RPY) se obtiene de rotaciones con respecto a los 
ejes fijos o absolutos comenzando con un sistema de referencia {A} y finalizando 
en el sistema de referencia {B} de la siguiente manera (ver figura 2.7): primero se 
rota con respecto al eje x4 absoluto un ángulo y (se emplea Rx4,y para representar 
ésta rotación, y la operación se denomina yaw); luego se rota con respecto al eje y4 
absoluto un ángulo 8 (se emplea Ry,,g¿ para representar esta rotación, y la operación 
se denomina pitch); finalmente se rota con respecto al eje z4 absoluto un ángulo a (se 
emplea Rz,.a para representar esta rotación, y la operación se denomina roll). Por lo 
tanto, se obtiene la siguiente matriz de rotación resultante que relaciona los sistemas 
de referencia” {B} y {A}: 


Rá(v,B,a) = ReraRyapRxa, 
CaCg CaSgSy — Saly CaSgCy + SaS» 
= Sata SaSg8y + Caly SaSgCy — CaSy (2.5) 
—88 CS», Cal, 


Una vez que se tiene la matriz Rô, se pueden obtener los ángulos a, $, y tomando en 
cuenta la estructura general de la matriz de rotación que se indica a continuación: 


TEn la expresión (2.5) se usa la notación sa,cg para representar de modo simplificado a 
sin(a), cos(8), respectivamente. 
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Ta T2 713 
R= į ra T22 T23 (2.6) 
| Tar T32 T33 ] 
Para obtener los ángulos requeridos nótese que si se seleccionan los elementos 711 y 
ra1 de la matriz (2.5), entonces: 


y ri +ra = Vicaca) + (sacg)* 


a 2 02 22m. da 2 
= TE T SaCg = Cg es T sa) 
y se tiene el elemento r3, = —sg, por lo queë: 


8B = Atan2 (rss, y r2 + 1) 


Siguiendo el procedimiento descrito anteriormente es posible obtener las siguientes 
expresiones para los ángulos a y y: 


Cg CB 
T32 T33 
y = AÁtan2 (2, — 
C8 CR 


Figura 2.7 Parametrización de rotaciones Roll-Pitch-Yaw. 


SEn este caso se emplea la expresión A tan 2 (y, x) para obtener tan”! (y/x), debido a que ésta 
función emplea la información de signo de su argumento para determinar el cuadrante en el cual se 
encuentra el ángulo resultante. 
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Las soluciones anteriores se obtuvieron seleccionado el valor positivo de la raíz cuadra- 
da respectiva. Con esto se asegura que —90° < 8 < 90. Un caso importante se presenta 
cuando 3 = 90°, debido a que en este caso sólo es posible obtener la diferencia o suma 
de a y y, puesto que al sustituir dicho valor en (2.5) se obtiene: 


p 0 Casy — Saly CaCy + Sasy O 8x-a Ga 
Rz (y, 90, a) = O Sasy +Caly Saly—Casy | = 0 Cra —S-a 
-1 0 0 -1 0 0 


Para esta última matriz de rotación, si se divide el elemento r,2 entre el elemento r13, 
lo único que se obtiene es tan (a — y), y al calcular la tangente inversa se produce el 
siguiente resultado: 


y-a=k 


para algún valor constante k. En conclusión, en este caso se obtiene una ecuación con 
dos incógnitas, por lo que el número de soluciones de dicha ecuación es infinito. En 
casos como este se dice que la representación muestra una singularidad. 


2.4.2 Ángulos de Euler Z-Y-Z 


En este caso se supone que se quieren relacionar los sistemas de referencia {A} y {D}, 
considerando los sistemas de referencia intermedios {B} y {C}. El sistema {B} se 
obtiene a partir de (A) por medio de una rotación con respecto al eje z absoluto un 
ángulo a (Rz.a). Luego se obtiene el sistema de referencia {C} al rotar {B} con respec- 
to al eje y actual un ángulo P (Ry 5). Finalmente, el sistema {D} se obtiene al rotar 
{C} con respecto al eje z actual un ángulo y (RR, ,). Todas las operaciones anteriores 
se indican en la figura 2.8. De esta manera, se tienen las matrices de rotación: 


R$ q. Raza 
RE = Rp 
R5 = Ra, 


por lo que la matriz de rotación resultante que relaciona los sistemas de referencia 


(A) y {D} es: 


RA (np = RERERE =R, ¿Ry ¿Ras 
CaCfCy — 8a8y —CaCg8, — Saly Casp 
= SaCgCy + lady —SaCg8y, + Caly SaSg (2.7) 
—$8C» SS» CR 
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de donde, suponiendo 8 # 0 y siguiendo el mismo procedimiento que en la parametrización 
Roll-Pitch-Yaw., se obtiene: 


8 = Atan2 (y r3 + T23, rss) 


T33 T13 
Sá 3 Sá 


y = Atana (22,722) 


Q = Atan2 


S8 Sa 


Figura 2.8 Parametrización de rotaciones por medio de ángulos de Euler ZYZ. 


De modo similar al caso de la parametrización Roll-Pitch-Yaw, cuando 3 = +180° se 
obtiene: 


=CaCy = Sasy Caty = JaC Ü =Ca=y “Sasy Ü ] 
RE (a,B,y) = | —8Saly + CaSy Say FCaly 0| =| —Say Cay O 
| 0 0 1 ] | 0 0 1 | 


y otra vez se llega a una solución en la cual no es posible determinar un conjunto 
único de valores para a: y y, es decir, se presenta el problema de singularidad. 
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2.4.3 Representación eje-ángulo (eje arbitrario) 


Para esta representación supóngase que se tienen los sistemas de referencia {A} y {B}, 
donde {B} se obtiene al hacer una rotación de {A} con respecto al vector unitario 


T A Del ; 
k = [kz, ky, kz} en un ángulo 0, como se indica en la figura 2.9. 


Figura 2.9 Parametrización de rotaciones por eje arbitrario. 


Empleando la figura 2.9, la matriz de rotación Rx. o puede obtenerse por medio de 
rotaciones con respecto a los ejes actuales como lo indica la siguiente expresión: 


Rio 7 Ra aRy pRs 9 Ry, -pRa,-a 


El desarrollo de la expresión anterior puede ser complicado. Por lo tanto, se propone 
una alternativa para el cálculo de Rx y. Considérese la figura 2.10. En dicha figura se 
muestran los vectores p*,p*, donde p” se obtiene al rotar p^ con respecto al eje k 
en un ángulo 0. 
Las componentes del vector p* son b,,b y pueden calcularse directamente como: 
b = p”-(p”,k)k 
b» = (p*,k)k 


donde (+, +) representa el producto punto entre sus argumentos. 


Las componentes del vector p* son a,.az. Los valores de dichas componentes se 
pueden calcular de la siguiente manera: 


ar = {p” — (p*,k)k) cos(0) + [k, {p” — (p?, k)k)sen (0)] 
(p?,k)k 


(42 
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donde [-.-] representa el producto cruz entre sus argumentos. 


Empleando las expresiones anteriores para aq, ag, se reescribe el vector pê de la 
siguiente manera: 


p^ = p” cos(0) + kk” [1 — cos(0)]p* + [k, psen (0)] 


por lo que se obtiene: 


pe = Rip? 


= p” cos(0) + kk" [1 — cos(0)]p* + S(k)p*sen (0) 
donde 


Rx.o = I cos(0) + kk” [1 — cos(0)] + S(k)sen (0) 


con 7 € IR**? la matriz identidad. Desarrollando los términos de la expresión anterior 
se obtiene la siguiente ecuación, correspondiente a la matriz de rotación con respecto 
a un eje arbitrario: 


k2vg + Co krkyvo — k2zso krkzvo + kySo 
Rk.o = | Kkxkyvo + kz80 kvo + Co kykzvo — kz 589 (2.8) 


kk¿V9 — kyso kyk¿Vo + Kz80 k2v9 + co 


donde vo = 1 — cy y k = [kz, ky, EJ”. 


xi 


ONIS aii 
N 


Figura 2.10 Rotación de un vector con respecto a un eje arbitrario k en un ángulo 8. 


De la figura 2.9 es fácil obtener las siguientes expresiones: 
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ky 


sen Q = — p, cosa = 


r 


kz 
Ea 


sen 3 = cos = k, 


Nótese de (2.8) que: 


ri + T22 + r33 = 1 + 2cos0 


por lo que se obtiene fácilmente la siguiente relación: 


0 = cos} | Ca id i 3) = cos™! (= = =) 
£ 2 = Cos 2 


732 — Ta; 
1 32 23 


14 =:T31 
= sen 0 
i Md a he 


donde tr (-) denota la traza de su argumento”, con 0 € (0, 180). 


Nuevamente, los cálculos para determinar k fallan si 4 = 0 o 0 = 180°, por lo 
que en dichos casos vuelve a aparecer el problema de singularidad. Además, esta 
representación no es única debido a que la rotación de un ángulo —0 con respecto al 
eje —k es equivalente a una rotación de 0 con respecto al eje k. 


2.4.4 Cuaterniones 


Todas las parametrizaciones de las matrices de rotación estudiadas hasta el momento 
presentan el problema de las singularidades. Éste problema es característico de las re- 
presentaciones mínimas, sin embargo, puede resolverse si se emplean los denominados 
cuaterniones. 


La representación de orientación por cuaterniones se debe a Hamilton [6], y son 
muy útiles en robótica debido a que no sufren de los problemas de singularidades 


%Dada la matriz cuadrada A € R”"*", la traza de dicha matriz se denota como trA y consiste en 
la suma de los elementos de la diagonal principal. Por ejemplo, para: 


-1 3 
[73] 


trA=-14+4=3 


se tiene: 
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planteados para las representaciones anteriores. A continuación se presenta la defini- 
ción de los cuaterniones. 


Cuaternión 


Una construcción de tipo: 


A := ào + (Ari + A212 + Azia) „A; ER,j=0,1,2,3 


se denomina cuaternión o parámetros de Euler. 


Los elementos i,,12.13 son operadores que deben cumplir las siguientes propiedades: 


iiz = 13 ii = 1,14 = i2 
ii = —13,i312 = —11,1113 = —i2 
1jlj = -1,j=1,2,3 
para todo iz, con k = 1, 2,3. Normalmente se dice que Ay corresponde a la parte 


escalar del cuaternión, mientras que el resto del cuaternión se refiere como la parte 
vectorial del mismo. La adición de cuaterniones se obtiene sumando los componentes 
respectivos de manera separada, por lo que los operadores funcionan como sepa- 
radores. De esta manera, una suma usual de cuaterniones es de la siguiente forma: 


3 
A+ A = (Ao + o) + Y (Ar + ôx) in 
k=1 


Dado el cuaternión A, se le puede representar de la siguiente manera: 


3 
A = 60 +) óxi = ôo + ô 
k=1 


Sean los cuaterniones {A, r, ®} y los escalares (A, 1), entonces se cumplen las si- 
guientes propiedades algebraicas: 


L. A4PT=TP+A 
2. (A4+4T)+0=A+(T + 9) 
3. AA=AA 
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4. (Au) A = àA (uA) 
5. (A+ p)A =AA +A 
6. AMA+T)=AA+ AT 


Sean los cuaterniones A = Ay +A y A = ĝo + 6, el producto de dos cuaterniones 
A o A está dado por: 


AoA = (A+A)o (ðo +ô) 
= Ando + A0Ó + oA + Ad 
= Ando + Ao (9111 + ô2i2 + ĝ3i3) + $0 (A111 + A212 + Aziz) 
+ (Aiii + Azi2 + Aziz) (0111 + 022 + Ó3i3) 
= Aofo + A0ó + SoA + (A1i1) (9111 + 0212 + Ó3i3) 
+ (A2i2) ($111 + d2i2 + Ó3i3) + (Aziz) (6111 + 022 + Ó3i3) 
= Ando + A0Ó + oA + (A1ó11111 + Aró211 12 + A1031113) 
+ (A2011211 + Azó2i2i2 + Azó3i2i3) + (Asóisir + Asd2izi2 + Azózizis) 
= Àofo + And + oA + (-A161 + A102i3 — A103i2) 
+ (—A20113 — A202 + A203i1) + (A301i2 — Azó2i1 — Azós) 
= Ando + Aof + YA — (A1Ó1 + AzÓ2 + A383) 
+ (A203 — A302) i1 + (A3Ó1 — A103) i2 + (A102 — A201) iz 


por lo que, empleando las definiciones del producto punto y producto cruz, se obtiene 
la siguiente fórmula para el producto de cuaterniones: 
AoA = (ào +A) o (ôo +0) = Ando — (A, 8) + Ao + IA + [A, ô] (2.9) 


donde (-, +) representa el producto escalar y [-,-] el producto vectorial. 


Considerando nuevamente los cuaterniones (A, T, 9), se tienen las siguientes propie- 
dades adicionales: 


1. (AoT)ob=Ao(To9D) 
2. Ao(T+%)=Ao0TP+A09 
3. (A4T)od=A0b4+T 09 


En general, el producto de cuaterniones no es conmutativo. Sin embargo, el producto 
de cuaterniones será conmutativo cuando la parte vectorial de alguno de los cuater- 
niones sea cero, o cuando las partes vectoriales de los cuateniones sean proporcionales. 
Lo anterior se debe a que en cualquiera de los casos mencionados desaparece el pro- 
ducto cruz. 
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El cuaternión cero se define como: 


y corresponde al elemento nulo para la suma de cuaterniones. De la misma manera, 
el elemento nulo para la multiplicación de cuaterniones es: 


3 
A=1+)-0-iz 
k=1 


Cuaternión conjugado 
Considérese el cuaternión A = Ay + A. Se define el cuaternión conjugado Á como: 


A = ào- À 


Sea A un cuaternión y A su conjugado. Entonces: 


Un cuaternión unitario será aquel en el que se cumpla que A o A = 1. Los cuater- 
niones unitarios se emplearán más adelante para la descripción de orientaciones. 

Los vectores usuales en IR* pueden describirse como cuaterniones en los que su 
parte escalar sea cero. De este modo, el vector r = (a,b, e)” puede expresarse como 
el cuaternión r = ai; + biz + ciz. Antes de comenzar con las aplicaciones para repre- 
sentación de orientaciones empleando cuaterniones, es útil considerar una definición 
equivalente de lo que se considera una matriz de rotación. 


Matriz de rotación 


Sea v € R? y R € R?*3, Se dice que la matriz R es de rotación 


siempre que se cumpla la siguiente relación: 


lRvi| = [lvl 
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Ahora se plantearán algunas propiedades de los cuaterniones, comenzando por la 
definición de la norma de los mismos. 

Norma de un cuaternión 

La norma de un cuaternión A se define como: 


[A =WA0A=vVA0A (2.10) 


Nuevamente, empleando la definición del conjugado de un cuaternión y norma de 
cuaterniones, se obtienen las siguientes propiedades: 


a) El conjugado del producto de dos cuaterniones es igual al producto de los con- 
jugados de dichos cuaterniones, pero en orden inverso, es decir: 


ASA=0A 
b) La norma del producto de cuaterniones se puede expresar de la siguiente manera: 


[Ao A|| = |A|] [Al 


puesto que: 


lAo Al? = (A0oAJo(A0A) 

= (AoA)o(AoA) 

= AoÃ- JA]? 

= [AJÍ Ao A = Al? A? 


c) Si A % 0, el inverso de dicho cuaternión AT! por definición es un cuaternión 
que satisface la siguiente propiedad: 


ATloA=Ao0A"?*=1 


donde se debe recordar que: 


[AI = ADA 
AoA 

1 = ——, lA] 40 
AJÍ 
Lo. A 
A IAI? 
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por lo tanto, el inverso de un cuaternión se obtiene de la siguiente manera: 


a, Å 
WT 
Al] 


d) La norma del cociente de dos cuaterniones es igual al cociente de la norma de 
dichos cuaterniones, es decir: 


le 
Ti IT 


e) La inversa del producto de n cuaterniones es igual al producto de las n inversas 
de los cuaterniones individuales en orden inverso, es decir: 


(Aro A20--:0An) * = Az o A71 0- o AZ 0 A7? 


Sea IAI? =) + Dis Az un cuaternión unitario. En este caso, es claro que Ay < 1 
y, por lo tanto, el cuaternión puede expresarse mediante las funciones sen (+), cos (+) 
como se muestra a continuación. Supóngase que: 


Àg = cos $ 


Como A = ào + À y A es unitario, se concluye que: 
Al? = 1 -— 3 = 1 — cos? 5 = sen? 5 


que implica que ||A|| = sen £, por lo que existe un vector unitario e tal que (ver figura 
2.11) 


A es E, llel|=1 
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X 


Figura 2.11 Rotación de un vector empleando cuaterniones. 


Por lo tanto, el cuaternión normalizado A = Anormalizado Siempre puede expresarse 
como: 


A = cos : + esen : = Anormalizado = ÅN (2.11) 


A continuación se presenta el teorema principal que indica el uso de los cuaterniones 
como operadores de rotación. Se recomienda leer la demostración del mismo para tener 
una idea más clara de lo que realmente se hace para poder considerar a los cuaterniones 
como operadores de rotación. Más adelante se verá que es posible emplear una matriz 
de rotación especial donde intervienen los coeficientes de un cuaternión para realizar 
operaciones de rotación. 


Teorema 2.1 


Sean los vectores r, e € R? y el cuaternión normalizado A y expresado con respecto 
al vector unitario e como se indica en (2.11). Entonces, la operación: 


rê = Ayo reo Ân (2.12) 


B con respecto al eje e, en un ángulo £. 


corresponde a la rotación del vector r 
Demostración 
Primero debe mostrarse que (2.12) corresponde a una rotación. Para ello basta con 


probar que su norma es la misma tanto antes como después de la rotación, es decir, 
que: 
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r4] = Al! lle’ Axl 


Claramente, [|Ay|| = 1, por lo que llel = llr” |]. Ahora se demostrará que las 
componentes del vector rê y r? sobre e son iguales, es decir, que: 


Considérese el plano formado por los vectores r” y e, y sea 8 el ángulo que existe en 
dicho plano entre los vectores rë y e. Sean i; e is los vectores canónicos de un sistema 
de coordenadas asignado en el plano anterior en cuyo origen se ubican los vectores r? 
y e, suponiendo que i; = e. De esta manera se obtiene la siguiente expresión: 


r? = lr?!) (i, cos O + issen 0) 


Considérese la siguiente operación: 


AnyoioÁy=Ayo fi o (a — esen 3) 


Empleando la definición de producto de cuaterniones se obtiene: 


i o (a — esen 5) = oi — (i. —esen 5) + [h —esen 3 


y dado que i; = e: 
i o (a — esen 3) = Aoi + (in, esca £) 


además: 
0 — esen 5) oi = Aoi- (=esen £i) + -esen 5.1] 


= AÁgi + (esen 5) 


por lo que: 


entonces se obtiene: 
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AyoioAÁy = Avn o [Äx oi] 
AvoÁyoi, i= lAxl? i 


Por otra parte, nótese que: 


(cos + iisen 5) o izo (cos; — isen 5) 
(iz cos £ + isen 5) o (cos £ — i,sen 5) 
q 2 2 2 


An oiz0 Åy 


o tad E E it 
= ¡i2cos 3 + igsen 2 cos 2 + igsen 2 cos 2 isen n3 
= ¡pcos* : + 2izsen > cos > — ipsen? : 


=  izsen é +i ( — 2sen? £) 


= isen +i (1 -2 (3 (1 - cos£))) 


= ¡pcos£ + izsen é 
por lo que, usando la propiedad: AyoioÁy = ii y AyoizoÁy = ia cos£ + igsen £, 
se obtiene: 
rê Aor oA 


AN £ : j E a 3 
(cos 2 + isen 5) o (Ile?) (i, cos O + iysen 0) o (cos pa isen 5) 


[lr2 1] (cos $ + isen £) o (iı cos + izsen 0) o (cos $ — i¡sen £) 


lr” || [iy cos ð + (i2 cos € + igsen £) sen 0] 


y multiplicando escalarmente por i, se llega a: 


wA i1) (Ir? [i1 cos 9 + (iz cos € + izsen €) sen 0] ,11) 


|r? || cos0 = ||r? || (G1 cos 0 + izsen 0) ,i1) = (1, i1) 


con lo cual se demuestra que la componente de ambos vectores sobre e es la misma, 
lo cual indica que (2.12) corresponde a una rotación. 
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Parámetros Rodríguez-Hamilton 


PERSA T i : 
Sea el vector unitario e = [x,y,2]” y A el cuaternión normalizado empleando el vector 
e. Los parámetros: 


= £ 

Ay = cos a, 
e: a (2.13) 

2 = ysen 3 

A3 = zsen $ 


se conocen como parámetros Rodríguez-Hamilton y definen la rotación del vector r 
un ángulo £. 


l Ejemplo 27 | 


Sea el vector v = [0,1, o”. Supóngase que se desea rotar dicho vector con respecto al 
eje x un ángulo € = 7/2. Para este ejemplo es claro que el eje con respecto al que se 
desea rotar es el eje e = x, por lo tanto: 


e=|[1,0,0]7 


Empleando (2.13), se obtienen los parámetros de Rodríguez-Hamilton: 


y de esta manera se calculan los cuaterniones: 


3 
A= ko +) Aii; 


>| 
Il 
ES 
| 
Mo. 
i 
i 
S 
| 
IS 


El vector rotado r se calcula empleando (2.12) como se indica a continuación: 
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i 


o(0+ i>) o 


v2 
2 


v2 


hi 


2 


) 


es decir, rê = [0,0,1], lo cual concuerda con el resultado que intuitivamente se es- 
peraba y muestra la aplicación de los cuaterniones como operadores de rotación de 


vectores. 


Ejemplo 2.8 


Supóngase que se desea calcular, empleando cuaterniones, el vector r 4, que se obtiene 


cuando se rota el vector rg 
Primero se distinguen los siguientes elementos: 


A= o +À 
donde: 
e = [0,0,1]" 
m V2 
iaai 7 E, A = Àz = Q, 
por lo que: 


y la rotación deseada se expresa como: 
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ra = AorgoÀ 
= E $ n) o (31, + 3i3) o E == n) 
_ [x2 x2, 3v2. _ 3V2, _ 3v2 _ 3v2. 
AE e si EA id E e 
= (Piti) sarna 
3/2 (V2 v2, v3, Z v2 v2 v3 v32, 
wi R a ar e a JD e E E e 


2 
3v 2 
= 3v2 (Vai, + V2is) = 3 + 313 


por lo que el vector resultante de dicha rotación es: 


que es el resultado que se esperaba visualizando esto gráficamente. 


De los parámetros de Rodríguez-Hamilton es claro que: 


AFA A+ Aj=1 


lo que indica que toda rotación puede verse como un punto en una hiperesfera 4- 
dimensional. Considerando que los cuaterniones pueden emplearse para representar 
rotaciones con respecto a un eje arbitrario e, puede retomarse la matriz de rotación 
con respecto a un eje arbitrario (2.8): 


k2vo + Co kykyvg — kz8g krkzva + kyso 


Rko = kykyUo + k.89 kivo + co kykzvo — krsSo 
| kzkzvo — kyso kykzvo + krso k?vo + Cg ] 


Considérese que se tiene el cuaternión A descrito por: 
A = ào + àii + Ala + A313 
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Si A es normalizado y se considera el eje arbitrario descrito por el vector unitario 
k= kz, ky, kJ" = e, y el ángulo ð = £, al emplear los parámetros de Rodríguez- 
Hamilton (2.13) se obtiene: 


cos? 3 + [k? + ki + k?] sen? : =1 


por lo que el elemento rı de Rx y puede descomponerse de la siguiente forma: 


k? (1 — cos €) + cos € 


= 122) [3 (1 cose)| -1+0 [3 (1-+cos£)] 


kvo + co 


= 2kĉsen? : — 1 +2cos? : 
= 2kĉsen? 7-12 h — (k? + k? + k?) sin? 5] 


= 2kĉsen? mi 14+2-2(k? + + k2) sen? £ 


= 1- 2k?sen?” 3 — 2k2sen? 


yj 


= 1-212-22? 


A continuación se muestra el desarrollo para los demás términos correspondientes a 
la matriz Ry y: 


kzkyvo + k:50 


krky (1- co) + 2k.5g0g 


Plz hy sh + 2,5909 =2 (Ar A 6 ApA3) 


kzkzvo — kySo ka kos4 - 2ky5gCg = 2(A1A3 — AvA2) 


krkyvo a k.580 = 2k.,k se — 2k.ss.co = 2 (A12 cii A0A3) 


k5ve + Cp 2k?s% 142% 
z 7 


= 239 -14+2(1- 4297 — ks? — 1253) 


taš (4203 ¥ kže? ) =1-22-22 
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kykzvo + kzs0 = 2kyk:5% + 2k,520g = 2 (4243 + A0A1) 
kzkzvo + kyso = 2kzkz5% + 2ky5g0g =2(4143 + AvA2) 


kyk¿v9 — kz30 = 2kyk:5% - 2kzSgcg = 2 (A23 — A0A1) 


kivo+co = 2k?s% -1+2 
= 2k?s5 -1+2 (1 — k2s? — kiss - K2s3) 
7 7 7 7 


1- 2k35% - 2ks% =1- 2) - 22 
Por lo tanto, la matriz de rotación equivalente empleando cuaterniones es: 


1 — 23 — 22 2(4142 — Ao0A3) 2(414A3 + AoAz2) 
Ra = 2(A142 ++ AvA3) 1- 21 222 2 (AA — AvA1) (2.14) 
2 (13 — ApAz) 2 (A243 + AoA1) 1 — 22 - 223 


de donde se observa claramente que: 


T32 — T43 

` = == 
Ao 

Tis. E31 

kl = = 
4o 

TIT 

ds AA 
4% 


1 
Ag a ¿Vi+ra + T22 + T33 


El resultado anterior hace pensar que, cuando Ay = 0, se tiene de nuevo el problema 
de la singularidad como en las parametrizaciones mínimas descritas anteriormente. 
Sin embargo, es posible obtener un conjunto de relaciones para cada elemento del 
cuaternión sin necesidad de realizar ninguna división como se indica a continuación: 


Ap = ¿Via + 7129 +r33 +1 
1=3v1 —T22—T33 +1 215 
= iVm Fra rat] iis 


con lo cual se observa que no se presenta el problema de las singularidades como 
en el caso de las parametrizaciones mínimas. Además, es posible demostrar que los 


Alfaomega Cinemática y Dinámica de Robots Manipuladores e Roger Miranda Colorado 


an 
n 


2.5 Rotaciones empleando cuaterniones 


cuaterniones y los ángulos de Euler se relacionan por medio de las siguientes ecuaciones 


[1]: 


Ao = cos 3 cos — 
a Y 
A1 = sen zoo -7 (2.16) 
f- . a—y . 
A2 = sen 5sin =y 


Ag = cos 7 sin 7 


_Ejemplo 2.9 


Supóngase que se obtiene {B} a partir de {A} rotando con respecto a z4 un ángulo 
de 60°. En este caso, los ángulos de Euler ZY Z son (0,0,60%). Empleando la ecuación 
(2.16) se obtiene fácilmente: 


Ay = cos Ê cos SH = Á 
àı = sen ¿cos 52 = 0 
%2 = sen Ê sin 2% = 0 
a = c08 Ê sin 2+2 = 1 
àz = cos 5 sin 7 =5 
o bien: 

P WL 

= -7 + zis 

2 2 


Ahora se verá otra forma de llegar al mismo resultado. Debido a que la rotación 
se hace con respecto al eje z un ángulo 0, el eje de rotación e correspondiente es 
e= z = [0,0,1] , por lo tanto, el cuaternión A = (Ap + A) se obtiene empleando los 
parámetros de Rodríguez-Hamilton descritos en (2.13): 


v3 


ào = cos30 = — 
Àl = 0, Az =i 

1 
Az = sen 30= 3 


por lo que se obtiene nuevamente el cuaternión: 


Ahora, se puede emplear la información del cuaternión A para obtener la matriz de 
rotación correspondiente de acuerdo a la ecuación (2.14): 
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que es el resultado esperado si se considera la matriz de rotación básica Rz.. De 
igual manera, empleando las ecuaciones (2.15) y la matriz anterior es posible obtener 
nuevamente los elementos correspondientes al cuaternión A como se indica a conti- 
nuación: 


Es 

A1 = Vr = r22 — T33 +1=0 
bV Fra ra FT =0 

ld = 3V -rn -rz +r + l= 4 


que es el mismo resultado obtenido inicialmente. 


2.5.1 Uso de MATLAB con matrices de rotación y cuaterniones 


Las matrices de rotación y los cuaterniones permiten tomar un conjunto de datos 
y realizar operaciones de rotación con ellos. De esta manera, es posible emplear el 
software Matlab para realizar programas que permitan visualizar fácilmente dichas 
operaciones, a fin de asegurar la comprensión total de las mismas. A continuación se 
muestran una serie de programas que permiten visualizar las operaciones de rotación 
empleando matrices de rotación y cuaterniones. 


El primer programa consiste en una señal sinusoidal en el rango [0, 27]. Dicha señal 
se rota empleando la matriz Rz. desde cero a 27 radianes. El programa para poder 
visualizar esta rotación en dos dimensiones se muestra a continuación: 
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Al ejecutar el programa anterior se debe de obtener una gráfica dinámica, en la cual 
se observa la señal sinusoidal rotando respecto al eje z, desde 0 = 0 hasta 0 = 27 
radianes. Ahora se generaliza el procedimiento anterior para visualizar la rotación con 
respecto al eje z, pero para una función en tres dimensiones. En este caso se emplea 
la función: z = ysin x, pero la base de las operaciones realizadas es la misma que en 
el ejemplo anterior. El código de éste nuevo ejemplo se muestra a continuación: 
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Cuando se implemente el código anterior se debe de observar una gráfica de una 
función en 3D, la cual se encuentra rotando con respecto al eje z. Se puede modificar 
este código en la parte de la matriz de rotación, de modo que se cambie el eje con 
respecto al cual rota la función graficada. Finalmente, se puede mostrar el uso de 
los cuaterniones para llevar a cabo rotaciones de acuerdo a lo descrito anteriormente. 
Para ello considéresense tres programas: 


1. Programa principal: Rotacion_03.m 


Alfaomega Cinemática y Dinámica de Robots Manipuladores e Roger Miranda Colorado 


2.5 Rotaciones empleando cuaterniones 59 


2. Función para realizar el producto de dos cuaterniones: rotaC.m 


3. Función para realizar la rotación empleando cuaterniones: opRotCuat.m 


El programa principal es Rotación _03.m, el cual se describe por medio del siguiente 
código: 
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En el programa anterior se emplea la función opRotCuat.m, cuyo código se muestra 
a continuación: 


Además, la función opRotCuat.m también hace uso de la función rotaC.m, cuyo 
código es: 
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function [re,rv] = rotaC(C1,C2) 

% Función que permite realizar el producto de cuaterniones 
Cie = C1(1); 

Civ = C1(2:end); 


C2e c2(1); 

C2v = C2(2:end); 

re = Clex*C2e - Civ**C2v; 

rv = Ciex*C2v + C2e*Civ + cross(Civ,C2v); 
end 


Al implementar el código anterior se debe de observar un comportamiento igual al 
obtenido con las matrices de rotación. Además, es importante tratar de comprender 
la forma en que se llevaron a cabo las operaciones en los programas mencionados, 
debido a que esto permitirá comprender la forma en que se aplican a los datos las 
matrices de rotación y los cuaterniones, pudiendo así extender el tipo de aplicaciones 
de los mismos. 


2.6 Transformaciones homogéneas 


Hasta el momento se han considerado operaciones de rotación en las cuales los orígenes 
de los sistemas de coordenadas coindicen y no existen desplazamientos. Sin embargo, 
cuando se tiene en mente un manipulador, el efector final realizará movimientos de 
rotación y traslación, por lo que es necesario comprender las operaciones que relacio- 
nan dichas tareas, como se describirá en esta Sección. 


2.6.1 Operaciones de traslación sin rotación 


Como primer paso para analizar las transformaciones homogéneas, considérese la figu- 
ra 2.12 [1], donde se muestran los sistemas de referencia (A), {B}, {C} y {0}. De 
acuerdo a lo mencionado en la definición de un sistema de referencia, éstos deben in- 
cluir tanto la información de su orientación como de la ubicación de su origen, por lo 
que una expresión adecuada para referirse, por ejemplo, al sistema {B} con respecto 
al sistema de referencia (A) es la siguiente: 
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(5) = (83.08) 


donde Rf indica la orientación de {B} con respecto a {A} y of representa el vector 
de posición del origen del sistema de referencia {B} con respecto al sistema {A}. 


Figura 2.12 Variedad de sistemas de referencia. 


Figura 2.13 Representación de un punto p en el espacio con dos sistemas de referencia trasladados 
pero no rotados. 


Considérese ahora la figura 2.13, donde se muestra un punto p en el espacio y los 
sistemas de referencia {A} y {B}, cuyos ejes son paralelos. Es sencillo observar de 
dicha figura que: 
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A A B 

pP =0g+Pp 

Dicha operación normalmente se conoce como mapeo de un vector de un sistema de 
referencia a otro, y consiste en expresar un vector de un sistema coordenadas a otro. 
Del mapeo anterior, el término que introduce información adicional es of. 


En este caso especial y sencillo, es posible obtener la representación del punto p en 
{A} simplemente mediante la suma usual de vectores, debido a que los sistemas de re- 
ferencia {A} y {B} son paralelos. Los casos más generales se muestran a continuación, 
en donde será necesario el uso de las matrices de rotación. 


2.6.2 Operaciones de traslación con rotación 


Considérese ahora la figura 2.14, donde los ejes de ambos sistemas de coordenadas 
{A} y {B} no son paralelos y sus orígenes se encuentran trasladados uno con respecto 
al otro. Para poder sumar dos vectores, estos deben de estar representados siempre 
con respecto al mismo sistema de referencia, de modo que la ubicación del punto p 
expresado con respecto al sistema de referencia {A} es: 


p? = 05 + Rip” 


Xa 


Figura 2.14 Dos sistemas de referencia con orientación diferente y una traslación entre ambos. 


En la ecuación anterior se incluye el término Rp” debido a que los sistemas de 
coordenadas no se encuentran alineados, por lo que primero se alinea el vector p? 
empleando RÅ, obteniendo su representación en (A). Además, nótese que: 
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e] PE] Jere 
1 0 1 1 0 1 ji 
La matriz T} se denomina Matriz de Transformación Homogénea. Dicha matriz 
relaciona el sistema {B} con el sistema {A}. La matriz de transformación homogénea 
contiene la información correspondiente a la orientación y la traslación de un cierto 
sistema de coordenadas con respecto a otro. Los vectores P? y PË se denominan 
vectores homogéneos y se obtienen simplemente agregando un uno a los vectores 
respectivos p?* y př. Por lo tanto, la forma general de la matriz de transformación 
homogénea que relaciona los sistemas de referencia (0) y (1) es: 


(x1,Xx0) (y1,X0) (Z1,Xx0) a ] 
To= | yo) (y1.yo) (Z1,yo) b 
(x1,Z0) (y1,Zo) (Z1,Zo) € 
0 0 0 1 


donde los elementos a, b, c determinan la traslación relativa a lo largo de los ejes x, y, Z, 
respectivamente, i.e., la ubicación del origen de {B} con respecto a {A}. 


2.7 Interpretaciones de las transformaciones homogéneas 


Al igual que con las matrices de rotación, las matrices de transformación homogénea 
pueden tener diversas interpretaciones como se muestra a continuación. En primera 
instancia, supóngase que la parte de rotación corresponde a un ángulo cero, por lo 
que R = I € R*** y considérese un único sistema de referencia como se muestra en 
la figura 2.15. Considérese el vector de traslación correspondiente como o = (a,b,c). 
Dado el vector homogéneo Pf = [[pf']", 1]7, al aplicársele la matriz de transformación 


siguiente: 
I o 
r=[a 1] 


se obtiene una traslación de dicho vector como se muestra en la figura 2.15, por lo 
que en este caso la matriz de transformación homogénea puede interpretarse como un 
operador de traslación. Supóngase que el vector trasladado se ubica con respecto a un 
sistema de referencia {B}, paralelo a {A}, y se representa mediante př. Entonces, la 
representación de dicho vector en un sistema de referencia {A}, denotado por på, es: 


A A B B 
P2 = 03 +p2 = Transo pz 


donde Trans, se denomina operador de traslación y es de la forma siguiente: 
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E 0 0 a | 
Transo = s . i » (2.17) 
0 0 0 1 


siendo of = o = (a,b, oy. 


Figura 2.15 Interpretación de una transformación homogénea como operador de traslación. 


De igual manera, si se considera una rotación y no se incluye ninguna traslación en 
la matriz de transformación homogénea, ésta puede interpretarse como un operador 
de rotación de un vector, correspondiente a lo analizado en la sección de matrices de 
rotación. En dicho caso las matrices de transformación homogénea pueden expresarse 
como Rotx y, donde el vector k indica el vector unitario a lo largo del eje con respecto 
al cual se realiza la rotación correspondiente, y Ó es el ángulo de rotación. 


Ejemplo 2.10 


r : aT 
Supóngase que se tiene el vector v; = [1,2,3] y se desea rotarlo 30° con respecto al 
: . í g 
eje z. Entonces se convierte el vector vı en el vector homogeneo V; = [1,2,3,1] y 
se emplea la matriz de transformación Rot, y como se indica a continuación: 
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cos30 —sen30 0 


v, E sen i cos rd 
0 
0 
1 
0 


Rot, 30V1 = 


0 

0 0 

1.0 

i O 1 
2 


por lo que el vector rotado es va = 2 al 3 ] 


Ejemplo 2.11- 


Sea el vector p^ = [1, 2, y”, Se desea rotarlo respecto al eje y 4 un ángulo de 45° 
trasladarlo 20 unidades a lo largo del eje x4 y 4 unidades a lo largo del eje y 4. Para 
determinar el vector p? resultante se realiza la siguiente operación: 


20 
PË -= Ry 4,45 a på 
0 1 


donde P? = [p?, y” y P? = [p?, e Por lo tanto: 


2 o Y 2]f1 2/2 + 20 
pë 0 1 0 4 2] _ 6 
0 0 0 1 1 1 
y el vector př resultante es: 
242 + 20 
p’ = 6 
v2 
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2.8 Composición de matrices de transformación homogénea 


Considérese la figura 2.16. En dicha figura se muestra el vector p“ y se quiere de- 
terminar p?, es decir, la representación del punto p dada por př, pero ahora con 
respecto al sistema de referencia (A). Para ello se observa que: 


Pp?" =T5P" 


Pp! = Tipe 
por lo que: 
P*=T¿P? = TÉTGPO 


donde: 


; RA o2 RE: jop 
ME 08] re [eat 


Además, es claro que debe de existir una matriz TE tal que: 


P^ = TPS 


por lo que se obtiene la siguiente relación: 


RARE Rog +oĝ 
0 1 


TÊ =T$Te = 


Figura 2.16 Ejemplo de composición de transformaciones homogéneas. 
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De la expresión anterior se concluye que la parte de la matriz de transformación ho- 
mogénea correspondiente a la orientación es simplemente la composición de rotaciones 
estudiada anteriormente, mientras que la parte correspondiente a la traslación es una 
suma de vectores, pero expresados todos con la misma orientación de un cierto sistema 
de coordenadas, para que dicha suma sea válida. 

Del análisis anterior, considerando la figura 2.17 [1], es posible obtener la siguiente 


relación: 


T3 = TQT =TSTETS 


Figura 2.17 Composición de transformaciones homogéneas para una 
diversidad de sistemas de referencia. 


Lo anterior es un paso importante cuando se conocen las matrices de transformación 
con respecto a un cierto conjunto de sistemas de coordenadas y se desean determinar 
otras matrices de transformación adicionales a partir de las ya existentes. Por ejemplo, 
si se conocen todas las transformaciones excepto TE , se le puede determinar como se 


indica a continuación: 


TRT = TRTETS 
—1 : -1 
TË = [18] "7278 [T5] 


y de igual manera: 
TE = TRT [T] =T8TE 
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De esta manera es posible obtener la matriz de transformación deseada a partir de 
un conjunto de matrices de transformación existente. 


2.8.1 Inversa de una transformación homogénea 


Algunas veces, como en el cálculo de TE anterior, es necesario conocer la inversa de 
la matriz de transformación homogénea para realizar ciertas operaciones. En dicho 
caso, sean los sistemas de referencia {A} y {B} y supóngase que se conoce la matriz 


P á i T 
de transformación homogénea que los relaciona: T. Es claro que RẸ = [R] y: 


B 
[05] =08 =08 + Ro% =0 


lo que implica: 


por lo tanto, la matriz de transformación homogénea en sentido inverso, es decir, qE 
que relaciona al sistema {A} con respecto al sistema {B}, está dada por: 


T T 
mg 18 = | RA” Ingo ] 


Ejemplo 2.12 


Sean los sistemas de referencia {A} y {B}, donde {B} se obtiene rotando de manera 
relativa a {A} con respecto al eje z en 30° y con la traslación de 1 unidad a lo largo 
de x4 y 2 unidades a lo largo de y4. La matriz de transformación homogénea TE es: 


[F -3 01] 
ai Saol 
ô 0 1.0 
0. 0.01 


mientras que: 


donde: 
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¡E o] 1] [-%42] 
T 2 2 2 
- [R$] of=-| 1 {3 - 2 | = | -2V43+1 
3 “2 2 
La afdol [3] 
S 101 Z l ọ 
AT 1 vá - ? Y3 
[RE = 3 + 0 na =5 == 0 
0 0 1 0 0 1 


Y 1 o -82 ] 
B Ay-1 k7 E 0 -2V3+1 
TA = [Tf] | PM: e di | (2.18) 
0 0.0 1 


Ejemplo 2.13 
Para el robot manipulador de la figura 2.18, supóngase que se conocen las matrices 


de transformación homogénea TE »TE y TP . Si se quiere determinar TE pueden 
emplearse las matrices conocidas de la siguiente manera: 


Te =TAT¿T0 =TAITAT TE)" 


Por otra parte, si se conocen las matrices de transformación PA x re: To y se quiere 
calcular TP, se puede proceder de la siguiente manera: 


TA =TETBTA = Te Tp ITE] 


De esta manera, al emplear la inversa de una matriz de transformación homogénea 
es posible obtener una matriz desconocida a partir de un conjunto conocido de ma- 
trices de transformación. 
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Figura 2.18 Ejemplo de aplicación de la inversa de una matriz de transformación homogénea. 


Ejemplo 2.14- 


Sean los sistemas de referencia {A} y {B} con orígenes coincidentes [1]. El sistema de 

a: 
referencia {B} se obtiene al hacer una rotación con respecto al eje k = (E, y, o] 
un ángulo 0 = 30°, con la condición de que dicho eje pase por el punto (1,2,3). 
Determinar Tf. 


Solución 


Para determinar {B} se supone que se tiene el sistema de referencia adicional {C} 
cuya orientación es la misma que (A) y un sistema de referencia {D} cuya orientación 
es la misma que la de {B}. Se supone que {C} y {D} tienen el mismo origen, el cual 
se encuentra en (1,2,3). En este caso la matriz de transformación Tf se obtiene 
empleando la matriz de rotación con respecto a un eje arbitrario (2.8): 


k2vo + co kzkyvo — kz89 kzxkzV0 + kySo 
Ruo= | kxkyvo + k250 k¿ve + co kykzvo — kz 80 
| kzkzvo — kySoọ kykzvo + kxS0 k2vg + co ] 


de la cual, al realizar los cálculos correspondientes, se obtiene: 


14/1434 1_.Y4W Y -/ 
1_Y3 1,v3 _y2 
eS ¿E 5354 -= 0 
a WE? SU 
Ej T z 0 
0 0 0 1 


Por otra parte, es claro que T = T¿TE£TE , donde: 
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[tet] [1 0 -1] 
TA=|? 10 2j rp- 0 1 0 -2| 
C iog 0 íi 3°82 10 0 1i —3 
looo 1] 000 i] 
por lo que finalmente se concluye que: 
[1001] HEE i] ag E 0 [1 0 0 -1] 
A a [0102 1-83 14% -4 0 0 ł 0 =2 
= = (7013 E A AY 0.001 -3 
0.0.0 1 0 0 o ılloo0oo0 1 
iv3+} 44343 12 } | 


A continuación se presentan algunos ejercicios adicionales que detallan los conceptos 
estudiados en este capítulo. Se recomienda al lector estudiarlos y realizarlos solo, 
verificando sus resultados con las respuestas que aquí se muestran. Cabe recalcar que 
en algunos casos las respuestas pueden no ser únicas. 


A 


Suponga que se tienen tres sistemas de referencia [0;1,y;2;), i = 1,2,3 donde: 


AE 
lo $ fp Lxo 0] 


Determine R3 [3]. 
Solución 


Claramente R} = R}R3, por lo que: 
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R? = [RI] " R} = [R}]" R} 

ig 
AAA AA 
lo 4 Y] lio o 1 |} 4 o] 


Ejemplo 2.16 


Los números complejos de magnitud unitaria (i.e., a + ib tal que a? +b? = 1) pueden 
emplearse para representar la orientación en el plano. En particular, para el número 
complejo a + ib se puede definir: 


b 
0 = tan”? — 
a 


Demuestre que la multiplicación de dos números complejos corresponde a la suma de 
los ángulos correspondientes [3]. 


Solución 


Sean los números complejos (a; + jb1) y (az + jb2). El producto de dichos números 
es: 


(a, + jb1) (az + jb2) = (aiaz — bib2) + j(arba + b1a2) 


En este caso se definen los ángulos 0, y 02 de la siguiente manera: 


1d 3 De 
0; = tan 12 0, = tan E 
a 


1 a2 
o bien: 
b e 
tanı = EM tan 0, = = 
a] a2 
por lo que debe demostrarse que: 
aiba + biao 


———— = tan (01 + 02) 
aiaz — bib 


pero se sabe que: 
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tan 0, + tan 0, 


tan (0, + 0: EPS 
an (01 + 02) 1 — tanÓ, tan 0, 


bi ba bia2+a1 ba 

ar T az BUS o biaz T aba 

1-4b amb ajaz — bib, 
ay az aia? 


lo cual demuestra que el producto de dos números complejos corresponde a la suma 
de sus ángulos correspondientes. 


Ejemplo 2.17 
Calcule la transformación homogénea que representa una traslación de 3 unidades 
a lo largo del eje x seguida por una rotación de 7/2 con respecto al eje x actual, 
seguida por una traslación de 1 unidad a lo largo del eje y fijo. Suponiendo que con 
las operaciones anteriores se obtiene el sistema {1}, ¿cuáles son las coordenadas del 
origen 0, con respecto al sistema de referencia original, i.e., cuál es el valor de o9? 


Solución 


De acuerdo a las operaciones mencionadas anteriormente, la matriz de transformación 
resultante TP puede obtenerse por medio de la siguiente operación: 


Ti = Transy Transx 3Rotx, z 
00.0 l 003 10.00 
e | 0 0 1 | | (O 1 50: (0 | | 0 0 -1 0 l 
E 0 1 0 0. 0 i 0 01 0 0 
0 0 1 O 0104 0.0 0 1 


1 
0 
0 
10 0 3 
| 0 -1 d 
t O g 
0 0 1 


aunque también pudo haberse llevado a cabo el siguiente procedimiento: 


T? = Trans(,1.0) Rotx, 5 
10.03 LO 0.0 I 0 0 3 
o 0.1.0 1 060-101 |0 0 -1 1 
a 0010 01 O OI Or 0/0 
0 0 0 1 900 q 1 0.0.0 1 
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. . . m . T 
Finalmente, a partir de la matriz T? se concluye que o? = [3,1,0]”. 


Ejemplo 2.18 


Considere el diagrama de la figura 2.19, donde la altura de la pieza es de 1 unidad, 
con 1 unidad de profundidad y base igualmente de 1 unidad. Determine las transfor- 
maciones homogéneas T’, TY, TÀ que representan las transformaciones entre los tres 
sistemas de referencia mostrados. Además, muestre que TÌ = TPT3 [3]. 


Figura 2.19 Diagrama con tres sistemas de referencia. 


Solución 


Una posible elección para las matrices de transformación homogénea buscadas es: 
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E = Transz, ı RRotx,¿ Rotz, — z 
p100o0][10 0 jpo 100] 
_$+0100 00-10 -1 00 0 
J 0601 1 01. 0 0 0 05120 
0.0.0 1 00 0 1 0 0.0 1 
ESEE 
j ° O -1 o | 
-=i 0 O 1 
loo o 1] 
T = Transy,1 Rot, z Roty,- z 
[194 01129 0 oja 01 0] 
= [917011100 10] 01 0 0 | 
0010 01 0 0 10.00 
Lo oo 1Jloo 0 illo o 0 1] 
[3 0 -1 0] 
ME i 1| 
1 0 
o o 1] 


0 
Lo 
Para la matriz T} se seguirá un camino complicado sólo para demostrar que el trayecto 


empleado no influye en el resultado final de la matriz de transformación. De esta 
manera se obtiene: 


TT = Rot, ¿Trans, ¡¿Rot, -z Rot, z Roty,- 
a 0.%4ol]f[100vY4][40-Lo0 
S 0 1.0.0 010 0 0 50. 
-2 0. 40 001 0 Lo 2.0 
0 0 0 1 000 1 0.0 0 1 
po sl EAT o | 
cl E e yA 01 0 0 
0.0 1.0 10 0 0 
0. 0 0 1 DO +A 
po -1 0 1] 
_ i0 0 -1 0 
= 1 0 0 -1 
O 0 y 1 


Ahora se verificará la composición de las matrices de transformación. Para ello, nótese 
que: 
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T? = TPT} 


donde 
o 1.0 0[[0 -1 0 1] |2 8-50] 
TOT) 0 0-10 0 0 -1 O0 į_i -10 0 1 
9 =1 0.01 10 0 -11 |O 100 
0 0 0 1 0.0 0 1 0 0 0 1 


que concuerda con el valor de TÌ obtenido anteriormente. Otra posible elección para 
obtener las matrices de transformación homogéneas buscadas es la siguiente: 


To = Rot% ¿ Rot, _¿Transx,-1 
¡10 9 9 [90 120 [100% | 
B 0 0 -1 Ô -= 000 010.0 
E 0.1.0.0 0.010 001 0 
00 0 1 0 0.0 1 0001 
0.1.0.0 
B o 0 =i 0 
E =A 0 QU 
0.0 0 1 
i H= = Transx Transz —ı Rotz, z Roty, — z 
[1001]f1 0 0 o [o =l 0 o]foo -1 0] 
a [LIN PRASOR 10.00 01. 0 0 
— 10010 001 0.0 1.0 10.000 
ooo1iJlooo 1 0 0 17 00 0 1 


T7 = Rot, -z Rot, _¿Transy 1 
0 0 -1 0 0. 100 1 0 0 -1 
E 01 0 0 -1 0 0 0 010 0 
ú 1 0 0 0 0 010 40010 
00 0 1 0 0.0 1 0o00 1 
0 0 -1 0 
o -1 0 0 1 
i 0. 1 0.0 
00 1 
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y al desarrollar las operaciones correspondientes se observa que se obtiene el mismo 
resultado. Lo anterior demuestra que no importa el camino que se elija para obtener 
una transformación homogénea, ya que la matriz final siempre será la misma. 


[j 


mplo 2.19 | 


Un sistema de referencia {B} se obtiene a partir de {A} de la siguiente manera: se 

rota con respecto al eje z4 en 30 grados; luego se rota respecto al eje x actual en 45 

grados. Determinar la matriz de rotación que cambia la descripción de los vectores de 
B A 

p ap. 


Solución 


Empleando el análisis de composición de matrices de transformación y el análisis de 
rotaciones con respecto al eje actual, se obtiene la matriz de rotación R resultante: 


R = Rz30Rxas 
CERA EA 
i 1 Y o A pap E Y _v8 
Lazlo ¿] lo 4 4] 
o 0 1Jlo% E 0o E Y 


Figura 2.20 Ejemplos de asignación de sistema de referencia. 
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Ejemplo 2.20 
A partir de la figura 2.20 determinar Tf£ [1]. 
Solución 
Para obtener {B} a partir de {A} se deben de realizar las siguientes operaciones: 
1. Traslación a lo largo del eje x4 una distancia de 3 unidades. 


2. Rotación con respecto al eje z actual un ángulo de 7 radianes. 


Por lo tanto, la matriz de transformación homogénea buscada es: 


De = Transx 3Rotz.- 
1003 -1 0 00 -1 0 0 3 
o 0.1.0.0 0 -1 0 0j 0 -1 00 
T 0010 0 VD i0 0 0 1 0 
0 0 0 1 0 0 0 1 0 0 0 1 
Ejemplo 2.21 


A partir de la figura 2.20 determinar TÉ. 
Solución 


Existen varias posibilidades para obtener {C} a partir de (A). Una posible solución 
consiste en seguir los siguientes pasos: 


1. Traslación a lo largo del eje x en 3 unidades y a lo largo del eje z en 2 unidades. 


2. Rotación con respecto al eje y actual un ángulo de 90? o 5 radianes. 


3. Rotación con respecto al eje x actual un ángulo de —30? o —¿ radianes. 
Por lo tanto, la matriz de transformación buscada es: 
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Té = Trans(3.0,2) Roty, 5 Rotx,- 2 


tu 
Oo” o 
O O O m 


Il 
EA 
coo» 
cono 
e SDrRoo 
ow 


0 
Je de de 
=|0 7 30 
-1 0 02 
0 0 0 1 


Ejemplo 2.22 
A partir de la figura 2.20 determinar T, A 
Solución 


En los ejercicios anteriores se obtuvieron las matrices TA y TE, por lo que es claro 
que: 


TÉ =T¿TE 
entonces: 
TE = [rg] T4 
1003] "To - 3 o 1 -L0 
0 -1 00 0 Yá i 0 gp DS sl g 
17 0 1 al a 3 A <A Y 0 2 
0 0 Qi 0 0 0 1 0 0 0 1 


De igual forma, es posible obtener dicha matriz de transformación siguiendo los si- 
guientes pasos: 


1. Traslación a lo largo del eje z en 2 unidades. 


2. Rotación con respecto al eje y actual 90°. 
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3. Rotación con respecto al eje x actual 150°. 


De esta manera: 


TA = Transz, 2 Roty 909 Rotx,150° 


y realizando las operaciones correspondientes se obtiene el mismo resultado. 


Ejemplo 2.23 
A partir de la figura 2.20 determinar TE 
Solución 


Del análisis anterior se conoce el valor de TÍ, es decir: 


0 0 0 


| ld a] | 0 0 sl: | 
2 2 
¡RT=| o E ij =j- £o 
a 5 a v3 1 
1 0 0 S 1 0 
0 0 -l1 3 2 
c AlTA 3 
0% = - [RÉ] oç =- -4 Ya 0 0 = 3 
Yg 1 2 —3y3 
2 2 0 2 


por lo tanto, del análisis de la inversa de una matriz de transformación se obtiene: 


e T 
T$ = [T4] = [rê] - [Ré] o4 


kE 
1 v3 
DERE 
l 2 

0 


E 


2 
0 
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Ejemplo 224 


Dos vectores vı y Və se encuentran unidos a un cuerpo rígido. No importa cómo 
se rote el cuerpo, siempre el ángulo entre dichos vectores se mantiene (es decir, la 
rotación de un cuerpo rígido preserva el ángulo). Use este hecho para demostrar que 
la inversa de una matriz de rotación debe de ser igual a su transpuesta y que una 
matriz de rotación es ortonormal. 


Solución 


Debido a la suposición planteada, es posible establecer la siguiente relación: 


|| Rvı — Rva]l| 
[PR [vi — va]l| 


lvi — vall 


Supóngase que esto no es cierto y que RRT 4 I, entonces: 


[vi — va]? RT R[vı — va] % [vi — va)” [vı — va) 


que implica que: 


IR [va — vell? # lliva — ve] 11 


lo cual es una contradicción, por lo que R7! = RT. Además, se sabe que det [RRT] = 
1 y det [RRT] = det (R) det (RT) = [det (R)}?, por lo que det (R) = +1. Realizando 
dichas operaciones para RRT y RTR se demuestra la ortonormalidad de los vectores 
fila y columna respectivamente. 


Ejemplo 2.25 


Dada la siguiente matriz de transformación, dibujar los sistemas de referencia que 
relaciona: 


o 
Oo” oso 


= 0 N =m- 
AAA 


Solución 
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Para resolver este problema es necesario recurrir nuevamente a la interpretación de 
la matriz de transformación y de la matriz de rotación. La forma general de la matriz 
de transformación es: 


Se sabe, por ejemplo, que la primera columna de Rf indica la orientación del eje x del 
sistema {1} con respecto a {0}. De esta manera es posible considerar las columnas de 
R? y concluir que: 


1. La componente de x, de (1) en el eje x de (0) es cero; la componente de xı 
de {1} en el eje y de {0} es 1 y la componente de x; de (1) en el eje z de (0) 
es cero. De lo anterior se concluye que el eje x de (1) es paralelo y coincidente 
con el eje y de (0). 


2. La componente de y, de (1) en el eje x de {0} es —1; la componente de y, de 
{1} en el eje y de {0} es O y la componente de y, de (1) en el eje z de {0} es 
cero. De lo anterior se concluye que el eje y de {1} es paralelo con el eje x de 
{0} pero tienen sentido contrario. 


3. La componente de z; de (1) en el eje x de {0} es cero; la componente de zı de 
{1} en el eje y de {0} es O y la componente de zı de (1) en el eje z de (0) es 
1. De lo anterior se concluye que el eje z de {1} es paralelo y coincidente con el 
eje z de {0}. 


or otra e. la última columna de indica que el origen de se obtiene a parti 
Por otra parte, la últir lumna de T? indica que el origen de (1 btier rtir 
de las siguientes operaciones: 


1. Traslación a lo largo del eje x en 1 unidad. 
2. Traslación a lo largo del eje y en 2 unidades. 


3. Traslación a lo largo del eje z en 3 unidades. 


Por lo tanto, la gráfica de los sistemas de referencia buscados se muestra en la figura 
7474 
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2; 


X1 


Figura 2.21 Gráfica de sistemas de referencia. 


2.10 Resumen 


En este capítulo se estudiaron aspectos relacionados con la rotación y traslación, de 


y 
modo que se abordó el concepto de matrices de rotación, parametrización de rotaciones 
y transformaciones homogéneas. 


Es importante notar que las matrices de rotación son útiles para muchas aplica- 
ciones debido a que, cuando se manejan distintos sistemas de coordenadas, al tratar 
vectores referidos a cada uno de ellos, se pueden realizar las operaciones deseadas de 
manera sencilla mediante la aplicación de dichas matrices de transformación. 


Por otro lado, las matrices de transformación homogénea representan una exten- 
sión de las matrices de rotación, en las cuales se incluye el efecto de las traslaciones. Lo 
anterior es importante debido a que los manipuladores no sólo presentarán movimien- 
to de rotación con respecto a un eje, sino que también presentarán movimientos de 
traslación, como en el caso de que se tenga una articulación prismática. En dichos ca- 
sos se requiere tener un elemento que permita obtener la relación entre varios sistemas 
de coordenadas que no solo difieran en su orientación, sino también en su ubicación 
en el espacio. 
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2.1 Indique cuál es la diferencia entre un punto p y un vector p' que lo represente. 
2.2 ¿Qué se entiende por un vector libre? 


2.3 ¿Qué condición debe de satisfacerse para que, dados un conjunto de vectores, sea 
posible realizar operaciones básicas (suma, resta, etc.) con ellos? 


2.4 ¿Qué es una matriz de rotación? 


2.5 Indique cuál es el procedimiento que debe de seguirse en la composición de ma- 
trices de rotación con rotaciones sucesivas, dependiendo de si estas se efectúan con 
respecto a un conjunto de ejes absolutos o un conjunto de ejes actuales. 


2.6 Indique cuáles son las representaciones mínimas que permiten parametrizar a una 
matriz de rotación y cuál es una representación no mínima que igualmente permite 
parametrizar a una matriz de rotación. 


2.7 ¿Qué es una matriz de transformación homogénea y cuál es la estructura de la 
misma? 


2.8 Cuando se aplica una matriz de rotación a un vector, ¿cambia la magnitud del 
mismo? Explique su respuesta. 


2.9 Cuando se aplica una matriz de transformación homogénea a un vector homogé- 
neo, ¿cambia la magnitud del mismo? Explique su respuesta. 


2.10 Se tienen dos sistemas de referencia (0) y (1). La matriz de rotación que rela- 
ciona a dichos sistemas de referencia es: 


0 0 1 

R=| 3 $o 

-Z l y 
F 3 


Determinar p° si p’ = [1,2, -ij 


2.11 En el ejercicio anterior, dado p° = [1,0, y", calcular p}. 
2.12 Supóngase que se parte de un sistema de referencia base y se llevan a cabo el 
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siguiente conjunto de rotaciones sucesivas: 


—_ 


. Rotación con respecto al eje z absoluto un ángulo a. 
2. Rotación con respecto al eje y absoluto un ángulo 8. 
3. Rotación con respecto al eje z absoluto un ángulo y 
4 


. Rotación con respecto al eje x absoluto un ángulo ð 


Determinar la matriz de rotación resultante de la combinación de las operaciones an- 
teriores. 


2.13 Supóngase que se parte de un sistema de referencia base y se llevan a cabo el 
siguiente conjunto de rotaciones sucesivas: 


1. Rotación con respecto al eje x absoluto un ángulo a. 
Rotación con respecto al eje z actual un ángulo $. 


Rotación con respecto al eje y absoluto un ángulo y 


e A 


Rotación con respecto al eje x actual un ángulo ð. 


5. Rotación con respecto al eje z absoluto un ángulo w 


Determinar la matriz de rotación resultante de la combinación de las operaciones an- 
teriores. 


2.14 Dada la matriz de rotación: 


v3 1 

[F o 3 
R=|l| 0 1 0 
1 v3 
EER. 


Obtener la parametrización eje-ángulo de dicha matriz de rotación. 


2.15 Sea el vector v = [2, —1, ar: Empleando cuaterniones, determinar el vector re- 
sultante w que se obtiene al rotar v con respecto al eje y un águlo € = 7/2. 


2.16 Sean los sistemas de referencia {A} y {B}. Inicialmente dichos sistemas de re- 
ferencia son coincidentes. Luego se rota {B} con respecto a xa (eje x del sistema de 
referencia (A)) 30? y se traslada 3 unidades a lo largo del eje x4, 10 unidades a lo 
largo de y4 y —1 unidades a lo largo del eje z4. Determinar la matriz de transforma- 
ción T que relaciona dichos sistemas de referencia. 
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2.17 En el ejercicio 2.16 sea p? = [0, —1,2]?. Determinar p^. 


2.18 En el ejercicio 2.16 calcular TE. 


2.19 Para el cuerpo de la figura 2.22 determinar Tf. 


2.20 Para el cuerpo de la figura 2.22 determinar T}. 


NS 


2.21 Para el cuerpo de la figura 2.22 determinar Tf. 


2.22 Para el cuerpo de la figura 2.22 determinar TË. 


15 


Figura 2.22 Variedad de sistemas de referencia sobre cuerpo tridimensional. 


2.23 Calcular de modo directo TÌ y verificar por composición de matrices de trans- 
formación dicho resultado. 


2.24 Calcular de modo directo Tx y verificar por composición de matrices de trans- 
formación dicho resultado. 


2.25 Calcular de modo directo Tf y verificar por composición de matrices de trans- 
formación dicho resultado. 


2.26 Diseñe un algoritmo en Matlab que permita graficar una señal, por ejemplo una 
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señal sinusoidal. Nótese que debido a que esta gráfica se muestra con respecto al plano 
xy. el eje z se encuentra apuntando hacia afuera de la pantalla donde se muestre dicha 
señal. Posteriormente realice las siguientes operaciones: 


1. Realice la rotación de dicha señal un ángulo determinado, por ejemplo 0 = 50°, 
con respecto al eje z. 


2. Realice un programa en el cual, de manera automática, se indique un ángulo de 
rotación y un incremento. El programa debe de tomar la señal y rotarla hasta 
alcanzar el ángulo introducido, donde cada paso de cada iteración corresponderá 
a los incrementos con la magnitud introducida. 


Nótese que, al realizar el programa anterior, en el paso 2 se debe de visualizar un tipo 
de animación, como si la señal se encontrara en movimiento continuo. Claramente se 
verá mejor dicha animación conforme se reduzca el incremento programado. 


2.27 Diseñe un algoritmo en Matlab que permita graficar una señal en tres dimen- 
siones. Posteriormente realice las siguientes operaciones: 


1. Realice la rotación de dicha señal un ángulo determinado, por ejemplo 0 = 30°, 
con respecto al eje y 


2. Realice un programa en el cual de manera automática se indique un ángulo de 
rotación y un incremento. El programa debe de tomar la señal y rotarla hasta 
alcanzar el ángulo introducido, donde cada paso de cada iteración corresponderá 
a los incrementos con la magnitud introducida. 


3. Ahora modifique el programa para introducir de modo adicional un vector que 
corresponda a una traslación del origen o”. El programa debe de tomar de modo 
directo la señal y comenzar a rotar y desplazarse hacia las nuevas coordenadas 
establecidas. 


Nótese que al realizar el programa anterior en el paso 3 se debe de visualizar una 
animación, como si la señal se encontrara en movimiento continuo, pero en este caso 
no sólo se debe de observar el movimiento rotacional, sino también el traslacional. 


Claramente se verá mejor dicha animación conforme se reduzca el incremento progra- 
mado. 


2.28 Repita el ejercicio 2.26 empleando cuaterniones. 


2.29 Repita el ejercicio 2.27 empleando cuaterniones. 
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La mayoría de las ideas fundamentales de la ciencia son esen- 
cialmente sencillas y, por regla general, pueden ser expresadas 


en un lenguaje comprensible para todos. 
Albert Einstein 


Competencias 
Al completar este capítulo el lector será capaz de: 
1. Interpretar y aplicar la convención de Denavit-Hartenberg. 


2. Realizar el análisis cinemático de un robot manipulador serial de 
cualquier número de grados de libertad. 


3. Describir el movimiento de cualquier parte de un robot manipulador 
con base en su análisis cinemático. 


3.1 Introducción 


Hasta el momento se han estudiado las propiedades de las matrices de rotación y las 
transformaciones homogéneas, asimismo se han asignado un conjunto de sistemas de 
coordenadas y se han establecido ciertas formas que permiten relacionarlos y traba- 
jar de cierta manera con cualquiera de dichos sistemas de referencia. Sin embargo, 
cuando se estudia un robot es importante contar con una metodología que permita 
la asignación de los sistemas de coordenadas de una forma ordenada y estandarizada, 
de modo que casi cualquier persona que analice dicha asignación tenga en mente un 
procedimiento similar y, por lo tanto, se facilite la presentación de resultados. 


En este capítulo se muestra cómo pueden asignarse los sistemas de coordenadas a 
un robot manipulador empleando la denominada convención de Denavit-Hartenberg. 
Se analizarán una serie de ejemplos que indican la forma de aplicar dichos resultados. 
Las bases de este capítulo son de vital importancia para la parte de Jacobiano y 
dinámica del manipulador, donde se mostrará finalmente la metodología para obtener 
el Jacobiano de un manipulador y las posibles aplicaciones del mismo. 


3.2 Convención Denavit-Hartenberg 


Es importante recordar que la cinemática es la parte de la física que se encarga 
del estudio del movimiento de un cuerpo sin considerar las fuerzas que lo originan, 
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mientras que la dinámica trata el estudio de las fuerzas o pares que originan dicho 
movimiento. 


Un robot manipulador de cadena cinemática abierta puede considerarse como 
un conjunto de cuerpos, eslabones, unidos mediante articulaciones en cadena ci- 
nemática abierta, las cuales pueden ser rotacionales, prismáticas, cilíndricas, planares, 
de tornillo o esféricas. 


Cuando se analiza un robot manipulador, puede considerarse que posee articu- 
laciones de un grado de libertad. debido a que una articulación de n—-GDL puede 
considerarse como un conjunto de n articulaciones de 1-GDL conectadas mediante 
n — 1 eslabones de longitud cero. En adelante los eslabones se enumerarán desde una 
base inmóvil (eslabón 0) hasta el extremo final del brazo (eslabón n). El eje con res- 
pecto al cual rota o se desplaza la articulación į se define por una línea en el espacio, 
representando el eje con respecto al cual el eslabón ¿ rota o se desplaza, de manera 
relativa al eslabón ¿— 1. 


Figura 3.1 Los eslabones mantienen una relación fija establecida 
por medio de los parámetros a;-.1 Y a;-1. 


En la figura 3.1 se muestra el eslabón į — 1 y los ejes de acción de las articulaciones 
i— 1l ei. El eslabón ¿— 1 puede caracterizarse empleando dos parámetros que definen 
la localización relativa de los dos ejes de las articulaciones: 


1. Para el primer parámetro considérense los dos ejes en el espacio de las articu- 
laciones (en la figura 3.1 se indican como los ejes ¿— 1 e ¿). Luego se establece 
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una línea normal a ambos ejes}. La distancia entre el eje ¿— 1 y el eje ¿ medida 
a lo largo de la línea mutuamente ortogonal entre los ejes se define por medio 
del parámetro a; y se conoce como longitud del eslabón. 


El segundo parámetro es el ángulo que define la orientación relativa de los dos 
eslabones y se denomina doblez del eslabón. Dicho parámetro puede obtenerse 
considerando un plano cuya normal es la línea mutuamente ortogonal a lo largo 
de la cual se mide el parámetro a;_1: luego se proyectan los ejes ¿— 1 e ¿į en 
dicho plano y se mide el ángulo entre ellos. El sentido que se considera para 
medir dicho ángulo es el siguiente: el ángulo se mide desde el eje ¿— 1 al eje ¿ 
aplicando la regla de la mano derecha, donde el sentido positivo está establecido 
por la dirección que se obtiene moviéndose del eje ¿— 1 al eje ¿. Este parámetro 
se denomina Q;_1. 


Por otra parte, dados dos eslabones contiguos, estos siempre tienen un eje en común, 
el cual permite establecer un tercer parámetro de interconexión. Dicho parámetro 
sirve para determinar la distancia que existe entre la línea ortogonal a lo largo de la 
cual se mide el parámetro a;_, y la línea a lo largo de la cual se mide el parámetro a;. 
Ésta distancia se mide a lo largo del eje común y se denomina offset del eslabón. En 
la figura 3.2 se considera que el eje común entre los eslabones es el eje ¿, y se indican 
las líneas a lo largo de las cuales se miden los parámetros a;_1 y a;. El parámetro de 
offset medido a lo largo del eje ¿ se identifica por medio de d;. 


Figura 3.2 Cuatro parámetros generales que caracterizan a un eslabón 
con las articulaciones adyacentes. 


l Esta línea normal o mutuamente ortogonal entre los ejes i — 1 e i siempre existe. Dicha línea es 


única si los ejes no son paralelos, mientras que, si los ejes son paralelos, existen un número infinito 


de líneas mutuamente ortogonales, en cuyo caso puede elegirse cualquiera de ellas. 
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Puede identificarse un cuarto parámetro, el cual establece la rotación existente entre 
dos eslabones contiguos, medida con respecto a su eje común. Dicho parámetro se 
denomina ángulo de la articulación y se identifica por medio de 0;, como se muestra 
en la figura 3.2. Para poder determinar dicho ángulo puede establecerse un plano tal 
que el eje ¿ sea normal al plano. Luego se proyectan en el plano los ejes a lo largo de 
los cuales se miden a; y a;. Posteriormente se mide el ángulo 0; aplicando la regla 
de la mano derecha, desde el eje correspondiente a a;-¡ hacia el eje correspondiente 
a a;, eligiendo el sentido positivo de rotación con respecto al eje ¿. 


De acuerdo al análisis establecido anteriormente, es posible sintetizar el significado 
de los parámetros d; y 0; de la siguiente manera: 


a d; es la distancia con signo medida a lo largo del eje de la articulación į, desde 
donde el eje en que se mide a;—ı intersecta al eje ¿ hasta donde el eje en que se 
mide a; intersecta al eje ¿. El offset es una variable si la articulación considerada 
es prismática. 


a (; es el ángulo que existe entre la línea a lo largo de la cual se mide a;_1 y 
la línea a lo largo de la cual se mide a;. Éste ángulo se mide con respecto al 
eje de acción de la articulación į, y es un parámetro variable si la articulación 
considerada es rotacional. 


Los parámetros a; y 0-1 dependen de los ejes ¿ e ¿— 1, por lo que los parámetros 
aj hasta a, -1 y Q1 hasta a, -, se definen de acuerdo a lo explicado anteriormente. 
Por convención, al inicio y al final de la cadena cinemática del robot se hace una 
asignación de modo que dichos valores sean cero, es decir, se asignan los ejes de modo 
que se obtenga: 


da = An = 0 


o = &a=0 


Por otra parte, d; y 0, están bien definidos para las articulaciones 2 a n — 1 de 
acuerdo a lo estudiado anteriormente. Para asignar los demás parámetros se emplean 
las siguientes consideraciones: 


a Si la articulación 1 es rotacional la posición cero para 0, es arbitraria, pero se 
elige preferentemente de modo que se obtenga dı = 0. 


s Si la articulación 1 es prismática la posición cero para dı es arbitraria, pero se 
elige preferentemente de modo que se obtenga 0, = 0. 


a Los mismos enunciados se aplican para la articulación n. 


El seguimiento de las consideraciones anteriores permite describir cinemáticamente 
cualquier robot empleando cuatro cantidades para cada eslabón. 
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Nótese que, de los cuatro parámetros considerados, siempre tres de ellos son cons- 
tantes y sólo uno puede ser variable. Por ejemplo, cuando la articulación considerada 
es rotacional, el parámetro 0; es variable y se conoce como la variable de la articu- 
lación, mientras que las otras tres cantidades son constantes y son los parámetros 
del eslabón. Para una articulación prismática, d; es la variable de la articulación y las 
otras cantidades son constantes. Esta forma de describir los robots manipuladores por 
medio de los cuatro parámetros a;-1,0-1,d;, 0, se denomina convención Denavit- 
Hartenberg (DH) |1]. 


3.2.1 Asignación de sistemas de coordenadas a los eslabones 


Una vez que se han establecido los cuatro parámetros que pueden caracterizar a un 
eslabón, el siguiente paso para el análisis cinemático es determinar, a partir de dichos 
parámetros, una metodología para asignar los sistemas de referencia a cada uno de 
dichos eslabones. Para conseguir este paso se deben seguir las siguientes reglas: 


a El origen del sistema de referencia {i — 1) se ubica donde la línea mutuamente 
ortogonal entre los ejes ¿— 1 e į corta al eje i — 1. 


a El eje z;_, coincide con el eje ¿— 1. 
a El eje x;—ı puede ubicarse de dos formas: 


1. Si existe una línea mutuamente ortogonal entre los ejes ¿— 1 e ¿, el eje x;-1 
se ubica a lo largo de dicha línea mutuamente ortogonal, con su sentido 
positivo apuntando hacia el eje ¿. 


2. Si los ejes ¿— 1 e ¿į se cruzan, el eje x;_/ se ubica de modo arbitrario, pero 
de modo que sea ortogonal a los ejes ¿— 1 e i. 


a El sentido positivo del ángulo a, se determina midiéndolo con respecto al eje 
X;-1 y considerando la regla de la mano derecha desde el eje z;_1 hacia el eje 
Zi. 


a El sentido positivo del ángulo 0; se determina midiéndolo con respecto al eje z; 
y considerando la regla de la mano derecha desde el eje x¡_¡ hacia el eje xi. 


En la figura 3.3 se muestra la ubicación de los sistemas de referencia {i — 1} e {i} 
para un manipulador general. 


El sistema de referencia (0) se une a la base del robot, es decir, el eslabón 0. Este 
sistema de referencia no se mueve y es arbitrario, por lo puede ubicarse de modo que 
sea coincidente con el sistema de referencia (1), cuando la variable de la articulación 
l1 sea cero. De esta manera se obtendrá ay = ay = 0 y dı = 0, si la articulación 
es rotacional, y 0, = 0 si la articulación es prismática. En el caso de la n—ésima 
articulación es posible considerar los siguientes puntos: 
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s Sila articulación n es rotacional, la dirección de x,, se elige de modo que coincida 
con X, 1 cuando 0, = 0 y el origen On se elige de modo que d,, = 0. 
a Sila articulación n es prismática, la dirección de x,, se elige de modo que 0,, = 0 


y el origen del sistema de referencia {n} se elige en la intersección de Xx, 1 y el 
eje de la articulación n cuando d,, = 0. 


di 


ai-1 AB , 


Figura 3.3 Ubicación de los sistemas de referencia {i — 1) e {i}. El sistema de 
referencia {i} se une al eslabón i. 


La tabla 3.1 indica cada uno de los parámetros de la convención DH y el significado 
de cada uno de ellos. 


Tabla 3.1 Interpretación de los parámetros de la convención DH. 


[ Parámetro DH | Interpretación >] 


distancia de z;_1 a z; medida a lo largo del eje x;_ 1 


ángulo entre Z;_1 y Zz; medido con respecto al eje x;_1 


| di || distancia dex;-, a x; medida a lo largo del eje z; 


y x; medido con respecto al eje Zi 


Nótese también que, en general, se considera que a; > 0, debido a que corresponde 
a la longitud del eslabón, pero [a;,0;,d;) son cantidades con signo. A continuación 
se presentan los pasos que deben de seguirse para asignar los sistemas de referencia a 
los eslabones de un robot manipulador. 
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Pasos para asignación de sistemas de referencia empleando la 
convención DH 


Identificar los ejes de las articulaciones ¿— 1 e i. 


Ubicar los ejes i— 1 e i. Si existe una línea mutuamente ortogonal entre 
dichos ejes, en el punto donde la misma cruce el eje ¿— 1 se asigna el 
origen 0;-1. Por otro lado, si los ejes se cruzan, en dicha intersección 
se ubica el origen 0;-1. 


Asignar el eje z;_, a lo largo del eje de la articulación ¿i — 1. 


Asignar el eje x;-, en la perpendicular común a los ejes ¿— 1 e å, 
donde el sentido positivo se elige apuntando hacia el eje i. En el caso 
de que los ejes ¿— 1 e i se intersecten, el eje x;_, se ubicará de modo 
que sea normal al plano que contiene los ejes ¿— 1 e į (en este caso la 
elección del sentido positivo del eje x;~ı puede no ser única). 


Asignar el eje y; para obtener un sistema con orientación derecha (i.e., 
de acuerdo a la regla de la mano derecha). 


Asignar el sistema de referencia (0) de modo que la primer variable 
de la articulación sea cero y el sistema de referencia {n} de modo que 
el mayor número de parámetros sea cero. 


Los pasos anteriores definen una metodología ordenada por medio de la cual pueden 
asignarse fácilmente los sistemas de referencia a los eslabones correspondientes a 
cualquier robot manipulador de cadena cinemática abierta. 


Ahora se aplicará la convención anterior para ilustrar la obtención del conjunto 
de parámetros de DH para un manipulador sencillo de 3-GDL. Una vez ejemplificado 
el procedimiento se establecerá la forma en que se debe considerar esta información 
para el cálculo de las matrices de transformación homogénea que caracterizan ci- 
nemáticamente el manipulador, el cual es precisamente el tema de mayor interés en 
éste Capítulo. 


3.3 Obtención de parámetros DH para robots manipuladores 


A continuación se mostrarán algunos ejemplos que indican la forma en que se aplica 
la convención DH para obtener los parámetros que caracterizan cinemáticamente a 
un robot manipulador. Es importante que, mientras se avanza en los ejercicios, se 
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vaya haciendo un seguimiento de las reglas e interpretaciones de los parámetros de la 
convención. 


Ejemplo 3.1 
Obtener los parámetros DH del robot de 3-GDL mostrado en la figura 3.4. 
Solución 


Siguiendo la convención de DH, los ejes de acción de todas las articulaciones son pa- 
ralelos entre sí, por lo que existen un número infinito de líneas mutuamente ortogonales 
entre ellos. En este ejemplo se considera la línea mutuamente ortogonal que pasa por 
el eslabón. Con esta elección se obtienen los orígenes 0, y 0, de la siguiente manera: 


1. El origen o, se ubica en el punto donde la línea mutuamente ortogonal a los 
ejes 1 y 2 cruza al eje 1. 


2. El origen 02 se ubica en el punto donde la línea mutuamente ortogonal a los 
ejes 2 y 3 cruza al eje 2. 


Para obtener el mayor número de parámetros del eslabón iguales a cero se elige el 
tercer origen Oz sobre el eje 3. De esta manera los orígenes 1, 2 y 3 quedan establecidos 
como se indica en la figura 3.5. 


Figura 3.4 Robot RRR. Figura 3.5 Asignación de los orígenes. 


Los ejes z se eligen a lo largo del eje de acción de las articulaciones. En la figura 3.6 
se muestra únicamente la ubicación del eje z}, pero los ejes Z% y Z3 se ubicarán en el 
origen respectivo con la misma dirección de z;. 


El siguiente paso es determinar el eje xı. Como los ejes Z y Z2 no se cruzan sino 
que son paralelos, se ubica una línea mutuamente ortogonal a zı y Z2, entonces X; se 
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posiciona a lo largo de la misma apuntando hacia el eje siguiente que es Z2, como se 
indica en la figura 3.6. Una vez que se determina dicho eje es posible asignar el eje 
yı siguiendo la regla de la mano derecha y, de esta manera, queda especificado por 
completo el sistema de referencia (1). 


Se realiza el mismo procedimiento para determinar el sistema de referencia (2) 
como se indica en la figura 3.7. 


Figura 3.6 Asignación del sistema de referencia Figura 3.7 Asignación del sistema de referencia 


{1}. {2}. 


Finalmente se asignan los sistemas de referencia {0} y {3} siguiendo las reglas es- 
tablecidas como se muestra en la figura 3.8. 

En la figura 3.9 se muestra la longitud de los eslabones y la forma en que se 
miden los ángulos. Obsérvese que el ángulo 0, se mide de xo a xı con respecto a zı. 
Igualmente, Lı es la distancia de zı a z2 medida a lo largo de xı y corresponde al 
parámetro aj. 

En el caso del eje x3, éste se elige de modo que coincida con el eje xə cuando 
03 = 0, mientras que el origen og se eligió de modo que d3 = 0. De igual manera, se 
eligió el eje xy de modo que coincida con el eje xı cuando 0, = 0, mientras que el 
origen Op se eligió de modo que dı = 0. 

Con los pasos anteriores ya han quedado establecidos todos los sistemas de refe- 
rencia que permiten describir cinemáticamente al robot manipulador. 

Ahora se obtienen los parámetros DH del manipulador, como se muestra en la 
tabla 3.2. 
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Figura 3.8 Asignación del sistema de Figura 3.9 Robot RRR con asignación 
referencia {3}. completa de acuerdo a la convención 
DH. 


Nota. En algunos casos, dependiendo de la forma en que se indique que se miden 
los ángulos, es posible que el valor del ángulo 0, sea de la forma 0, = (0; + 0;p), 
donde 0? denota el valor de la variable de la articulación, mientras que el valor 0jo 
indica algún valor inicial dependiente de la configuración inicial del manipulador. 
En dichos casos se puede agregar una columna adicional en la que se indiquen los 
valores correspondientes jo. En general, en el análisis que se realiza a continuación 
se considerará simplemente el valor del ángulo como 0;, sin embargo, más adelante se 
mostrarán algunos ejemplos en los que se indica explícitamente el valor de 0;0. 


Tabla 3.2 Parámetros DH para robot planar de 3-GDL. 


Ejemplo 3.2 
Considérese el manipulador de 3-GDL mostrado en la figura 3.10, el cual cuenta con 


tres articulaciones rotacionales, por lo que se trata de un robot tipo RRR. Determinar 
los parámetros DH del manipulador. 
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Solución 


Es importante notar que, a diferencia del manipulador del ejemplo anterior que se 
mueve en un plano, este manipulador es capaz de moverse en el espacio. Se siguen 
los mismos pasos que en el ejercicio anterior para determinar los parámetros DH. 
Primero se ubican los ejes de acción de las articulaciones, luego las líneas mutuamente 
ortogonales y a partir de esto se establecen los orígenes como se indica en la figura 
311: 


Figura 3.10 Manipulador RRR. Figura 3.11 Asignación de orígenes. 


Luego se ubican los ejes z y los ejes x de acuerdo a la convención DH. La asignación 
de dichos ejes se indica en la figura 3.12. 


Figura 3.12 Asignación de ejes z y ejes x. Figura 3.13 Asignación de distancias de 
acuerdo a la convención DH. 


Finalmente se obtienen las longitudes correspondientes como se muestra en la figura 
3.13. 

A partir del análisis anterior es posible obtener los parámetros DH, como se indica 
en la tabla 3.3. 
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Tabla 3.3 Parámetros DH para robot de 3-GDL. 


Ejemplo 3.3 


Sea el robot de 3-GDL mostrado en la figura 3.14. En este caso se indica la asignación 
del sistema de referencia {e} en el efector final. Determinar la tabla de parámetros 
DH del manipulador [1]. 


Solución 


Como primer paso se ubican los ejes de acción de las articulaciones, las líneas mutua- 
mente ortogonales y los orígenes. En este caso, todos los ejes se intersectan, por lo 
que todos los orígenes coindicen, como se muestra en la figura 3.15. Para el caso del 
origen 03, se ubica convenientemente de modo que coincida con los demás orígenes 
(0i y 02) para aumentar el número de parámetros que sean iguales a cero. 


Figura 3.14 Robot manipulador de 3-GDL. Figura 3.15 Ubicación de los origenes. 


El siguiente paso consiste en la ubicación de los ejes z, recordando que éstos se ubican 
coincidentes con los ejes de acción de las articulaciones del manipulador. La ubicación 
elegida se indica en la figura 3.16. 
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Figura 3.16 Ubicación de los ejes z. Figura 3.17 Asignación de los ejes x e y. 


Ahora, debido a que los ejes de las articulaciones se intersectan, los ejes x se ubican 
de modo que sean perpendiculares al plano formado por los ejes z correspondientes. 
Además, se muestran algunos ejes y para visualizar más detalladamente la asignación 
considerada. La ubicación final de los ejes se muestra en la figura 3.17. 


Posteriormente se asignan las longitudes de acuerdo a la convención DH como se 
indica en la figura 3.18. 


Figura 3.18 Asignación de distancias. 


Como paso final se obtiene la tabla 3.4, donde se muestran los parámetros DH de 
acuerdo a la información proporcionada por la figura 3.18. Es importante tomar en 
cuenta que en la figura 3.18 no se muestra explícitamente el sistema de referencia (0), 
pero siguiendo la convención estudiada, el origen oy se ubica coincidente con oy, el 
eje Zo coincidente con zı y Xo coincidente con xı. 
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Tabla 3.4 Parámetros DH para robot de 3-GDL. 


3.4 Cálculo de las matrices de transformación homogénea 


Hasta el momento sólo se han calculado los parámetros de la convención DH que 
caracterizan a los eslabones del manipulador, sin embargo, aún no se han establecido 
las matrices de transformación homogénea que permiten determinar las relaciones 
entre los sistemas de coordenadas asignados a cada eslabón. La obtención de dichas 
matrices de transformación es fundamental en todos los cálculos posteriores, desde 
la determinación del Jacobiano del manipulador hasta la obtención de las ecuaciones 
dinámicas y, por lo tanto, es importante mostrar de manera clara la forma en que han 
de obtenerse dichas matrices. 


Considérense los ejes ¿— 1 e i y defínanse los tres sistemas de referencia intermedios 
{A}. {B}, {C}, como se muestra en la figura 3-19. Se observa que: 


a El sistema de referencia (A) e ([i— 1} difieren sólo por una rotación de un 
ángulo a, con respecto al eje Xx;-1. 


a El sistema de referencia {C} difiere de (A) por una traslación de a;_1 a lo largo 
del eje x;_1. 


a El sistema de referencia {B} difiere de {C} por una rotación de un ángulo ð; 
con respecto al eje z;. 


a El sistema de referencia {i} difiere de {B} por una traslación d; a lo largo del 
eje Zi. 
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Figura 3.19 Ubicación de los sistemas de referencia intermedios {A}, {B} y {C}. 


Empleando las rotaciones y traslaciones establecidas anteriormente, se obtiene la ma- 
triz de transformación homogénea 7/7? que relaciona los sistemas de referencia {i} e 


fi — 1): 


Ti = T 'TATETP 


= Rotra 11an8za,., Rot; o Trans; a, 


y, realizando las operaciones correspondientes, se obtiene: 


Co, 80, 0 Ai-1 
; SC "9,0 E. —=d;s 
i-i ii S0; Caini Chi Caini Sai: 101 Si 
i | Shi Saini C9; Saini Caini dicos... | ( ) 
| 0 0 0 ioo] 


donde se emplea la nomenclatura co, sg para designar de manera abreviada a cos 6, sin O, 
respectivamente. De igual manera, la notación c12, 5,2 corresponde a cos (0, + 02), 
sin (0, + 02), respectivamente. Las expresiones que puedan surgir con mayor comple- 
jidad seguirán el estándar anterior. 


La matriz (3.1) será la que se emplee siempre que quiera obtenerse la matriz 
de transformación homogénea que relacione dos sistemas de referencia empleando la 
convención DH. La obtención de dicha matriz se muestra en los siguientes ejemplos. 

Ejemplo 3.4 


Determinar las matrices de transformación homogénea del robot mostrado en la figura 
3.20 cuya tabla de parámetros se indica en la tabla 3.5. 
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Tabla 3.5 Parámetros DH 
para robot planar de 3-GDL 


Figura 3.20 Robot manipulador planar de 3-GDL. 


Solución 


Aplicando la fórmula para la matriz de transformación homogénea "ri dada por 


(3.1) se obtiene: 


C1 —$1] 0 0 Ca -s2 0 Lı ] 
te S1 C1 0 0 i ae $2 Ca 0 0 
sye 0 0 1.0 a 0 0 1.0 
0 0 0 1 0 0 0 1 


Empleando los resultados anteriores se calculan las matrices TÌ y T% de la siguiente 


manera: 


T? =T} = 
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€123 — 8123 L¡c1 + Lacr2 | 


0 
0O _ mop _ | S523 Ci3 0 Lisi+L£L2512 
a e a ia 0 0O i 0 
0 0 0 1 


Las matrices anteriores definen completamente todas las características esperadas en 
el análisis de cinemática directa del manipulador, y servirán de base para cualquiera 
de los cálculos posteriores. 


Ejemplo 3.5 


Determinar las matrices de transformación homogénea del robot mostrado en la figura 
3.21 cuya tabla de parámetros se indica en la tabla 3.6. 


Tabla 3.6 Parámetros DH 
para robot planar de 3-GDL 


Figura 3.21 Robot manipulador de 3-GDL. 


Solución 


Siguiendo los mismos pasos que en el ejemplo anterior, se obtienen las matrices de 
transformación siguientes: 


ca -s 0 0 & -3 0 Li ca —=$3 O Lz 

0 S1 ĉi 0 0 kan 0 0 —-1 0 r EN $3 C3 0 0 
$i 0 0 10 3 s2 & 0 0 13 0 0 1 

0 0 0 1 0 0 0 1 0 0 o 1 
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y multiplicando las matrices anteriores se obtiene: 


| c&C —Ci82 51 lia | | cıC23 —C18938 Sı Laci + L2cic2 
T? 2 ¿Ta = m 


siC2 —S8182 —C1 Lis; s1C23 —S18233 —C1 Lisi + Los1cz 
$2 Ca 0 0 $23 C23 0 Lasa 
0 0 0 1 0 0 0 1 
Ejemplo 3.6 


Determinar las matrices de transformación homogénea del robot mostrado en la figura 
3.22, cuyos parámetros DH se muestran en la tabla 3.7 [1]. 


Tabla 3.7 Parámetros DH 
para robot de 3-GDL 


| | 
HOALE 
pe Ne 14 LCT 


[elfo WO || %e 190" | 


Figura 3.22 Robot manipulador de 3-GDL. 


Con los datos proporcionados se obtienen las siguientes matrices de transformación 
homogénea: 


a -5 0.0 ] co -s 0 0 ] 

o-a a. 0.0 1 SoCg Caty —S¿ 0 
n=] 0 0 1.0 [T= | 5289 C285 C 0 | 
0 0 0 1 ] | 0 0 0 1 | 

c3 -s3 0 0 | 0 -1 0 0 

2 S2Cġ C2Co So 0 3 1 0 0 0 
ds —828% —C284 —Co O Te 0 0 1 L, 
0 0 0 1 0 0 0 1 
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Aplicando la composición de transformaciones homogéneas, se calculan las matrices 
T? y 72: 


| C1C2 — $182Cg4  —C182 — $1C2C4 $155 0 


T? = S1C2+C182C4 —38182 + C1C2Cġ —C1ıSġ O 
e $284 C286 c 0 
0 0 0 1 


tu ti ti 

t t t 
T? = 21 t22 t23 
y ta t32 t33 
0 0 0 


n OOO 
— 


donde: 


ti = C1C2C3 — C38182C4 — estic, — $189 (sí + ccf) 

ti2 = —C1C283 — C1C252C4 ef $185253C4 — 81C2 (s3 $ cc) 
tig = —C1828% — 818¢Cọ (1 + c2) 

toy = $1C2C3 + C182C3C4 — 8183C4 + (182 (s3 $- caci) 

t22 =  —C28183 — C258182C¿ — C18283C4 + C1C2 (3 +- cach) 
t23 = —818284 + C1SġC (1 + c2) 

t31 = C3828¿— 82Cġ8ġ + C282C4S¢ 

t32 = —328358% — C2C484 + 3CoSo 

t33 = -c3 a C233, 


Puede realizarse un cálculo adicional para calcular T? mediante el producto TÌT?. 


Obtener las matrices de transformación homogénea para el manipulador Unimation 
PUMA 560 mostrado en la figura 3.23, cuyos parámetros respectivos se muestran en 
la tabla 3.8. 
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Figura 3.23 Robot PUMA 560. 


Solución 


Tabla 3.8 Parámetros DH 
para el manipulador PUMA 


109 


| La || 0 | 
po [9s 


Empleando los valores de la tabla 3.8, es posible obtener las siguientes matrices de 


transformación: 

je 
0 $1 
Ti = 0 
0 

| C3 

S: 

=| o 
0 

E 

0 

Ti = E 
0 


Sr» o 


| 
a 
no 
O O -o 


| Ca —$84 0 
: 0 o 1 
EAN 
Ti = -s4 —c4 0 
0 0 0 
| C6 — 86 0 
0 o l 
yoe 
16 o —8$6 —C6 0 
0 0 0 


= 


e.e O © 
hen nad 


Empleando la información anterior, se obtienen las matrices de transformación refe- 
renciadas al sistema (0), como se indica a continuación: 
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CıC2 —Ci82 -—S o] 


C1C23  —C18233 —8S1 —Las1 + agercz | 


T? = S123 —SiS233 C1  L3cı + a251C2 
—=5s23  —C23 0 —a282 
0 0 0 1 
$184 + C1C4C23 C481 — C184C23 —C1823 $14 
T? = —C184 + C4$1C23 —C1C4 — S1S4C23 —81823 $24 
. — C4823 84823 — C23 $34 
0 0 0 1 
si = —L3si + a92c1C2 + a3C1C23 — L4C1823 
S24 =  L3cí + 920281 + 43581093 — Las: 823 
S34 = —02823— Laca — 43823 


tu t2 tia tu 


T? = tor toas t23 ta 
` ta ts t33 t34 
0 0 0 1 
tir = C581S4 — C1858823 + C1C4C5C23 
ti2 = —818485 — C1C5$23 — C1C485C23 
ti3 = —C4$1 + C184C23 
tia = —L3sı + a2¢1C2 + a3cıC23 — L4C1823 
t21 =  —C]C584 — 8185823 + C4C551C23 
t22 = (18485 — (581823 — C48185C23 
tə3 =  C1C4 + $184C23 
toy =  L3ci + a20281 + 0381023 — Las1823 
t31 = —85C23 — C4C5823 
t32 = —C5C23 + C485823 
t33 = —S482 
t34 = —a2zs2— Laco3 — 43823 


y finalmente la matriz de transformación que relaciona el sistema de referencia {6} 


con el sistema de referencia {0} es: 
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“16 ia Tis: Tí 
T? T21 T22 T23 T24 


6€ | ra r32 T33 T34 
Tar T42 T43 T44 
donde: 
M1 = C4$186 + C5C68184 — C1C2C38486 — C1C2C68385 — C1C3C68285 
+C1 328383436 + C1C2C3C4C5C6 — C1C4C05C68283 
T12 =  C4C681] — 05818486 — C1C2C3C684 + 0106828384 + 0102538586 + 0103828556 
—C1C903C40586 + 010405828356 
Ti3 =  —818485 — C1C29C583 — C1C3C582 — C1C9C3C485 + C1C4828385 
T21 = —C1C486 — C1C5C684 — C2C3818486 — C206818385 — C3C6818285 + $182838456 
+C90304050681 — C40506818283 
T22 =  —C]C4C6 + 01058486 — C203C06 8184 + 0681825384 + 02818358586 + (381828586 
(90304058186 + 040581828386 
T23 =  C18485 — C2058183 — (3058182 — C2C3C48185 + (481528385 
T31 =  —C2C3C685 + C2838486 + (3828486 + C6$28385 — C2C4C5C683 — C3C4C5C682 
T32 =  C2C68384 + C3C68284 + C2C358586 — 82838586 + C2C4C58386 + C3C4C58286 
T33 = —C2C3C5 + C58283 + C2C48385 + C3C48285 
= T]l4 = —L381 + a2C1C2 + A3C1C2C3 ~ L4C1C983 pa L401C389 — (03018283 
b = ra = L3cC; + 09098, + a3C2C381 — L4C28183 — L4C3S182 — 43518983 
C = T34 = —4282 — Lacacz — a3C283 — 030382 + Las283 


Los ejemplos analizados anteriormente son básicos para aprender a utilizar las técnicas 
de análisis cinemático directo de robots manipuladores, sin embargo, se recomienda al 
lector que, una vez que hayan analizado y comprendido los ejemplos anteriores, trate 
de determinar la cinemática directa de robots manipuladores con cadena cinemática 
abierta de cualquier tipo, buscando en algunas fuentes de información los robots 
respectivos para aplicarles la metodología que se ha estudiado. 
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3.5 Problemas adicionales 


A continuación se proporcionan un conjunto de problemas adicionales, como com- 
plemento a los ejercicios anteriores. Se recomienda tratar de resolver los siguientes 
problemas de modo independiente, antes de ver las respuestas que se proporcionan. 


Ejemplo 3.8 


Sea el robot manipulador PRR. de la figura 3.24. Realizar las siguientes operaciones: 
1. Asignación de sistemas de referencia de acuerdo a la convención DH. 
2. Obtención de la tabla de parámetros de la convención DH. 


3. Cálculo de las matrices de transformación homogénea Tf, T}, etc. 


Figura 3.24 Robot manipulador PRR. 


Solución 


Empleando la convención DH se obtienen los sistemas de referencia de este manipu- 
lador como se muestra en la figura 3.25. 
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Figura 3.25 Asignación de sistemas de referencia. 


De la asignación de sistemas de referencia se obtienen los parámetros mostrados en 
la Tabla 3.9. 


Tabla 3.9 Parámetros DH del robot PRR. 


Empleando la información anterior, se obtienen las matrices de transformación del 
manipulador: 


E 0 Q Lı Ca —82 0 0 
0 0.1.0.0 L 0 0 1 Lz 
Ti E 0 0 1 d 1 i T3 E — 8S2 — C2 0 0 
000 1 0 0 0 1 
C3 —$3 0 0 1 0 0 0 
2 |0 0 -1 -b £ 10 00 
T3 = $3 C3 0 0 b Te E 0 0 1 L 
0 0 0 1 000 1 


El producto de las matrices de transformación permite obtener: 
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100 Lh]|| & -s2 0 0] 
0100 0 0 1 ¿Bs 
Dú ss Opl —_ 2 
Ta E Ti T2 0 0 1 dı —$) —Ca 0 0 
0.00 1 0 0 0 1 
| Ca 33 0 Ly ] 
0 0 1 Lz 
o —892 —Ca 0 dı 
0 0 O 1d 
Ca —$92 0 L; ] | C3 —83 0 0 
: 0 0 1 S 0 0 -1 -L; 
o 02 _ 2 3 
T3 == Tz T3 = | -52 —C2 0 dı | | S3 c3 0 0 | 
0 0 0 1 | | 0 0 0 1 ] 
| cac3  —Cas3 s2 Li+ L3s2 ] 
"E S3 C3 0 La | 
8203 $283 C2 dı +L3ca 
| 0 0 0 1 | 
Cota —CoSs3 S2 Li + L3s2 tO 0 p 
0 _ mm S3 C3 0 Lo 010 0 
Te dk 13 Te E —89C3 $983 ca di + Lze 0 0 1 Le 
0 0 0 1 0.000 1 
CaC3  —C2s3 $2 Li+(L3+Lo.)s2 
S3 C3 0 La 
o — S203 S8253 Ca dı + (L3 + Le) Ca 
0 0 0 1 


lo cual completa el análisis cinemático del manipulador. 


_Ejemplo 3.9 


Sea el robot manipulador RPP de la figura 3.26. Realizar las siguientes operaciones 
[1]: 

1. Asignación de sistemas de referencia de acuerdo a la convención DH. 

2. Obtención de la tabla de parámetros de la convención DH. 


3. Cálculo de las matrices de transformación To, T, etc. 
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Figura 3.26 Robot manipulador RPP. 


Solución 


Primero se obtiene la asignación de sistemas de referencia como se indica en la figura 
3.27. 


Figura 3.27 Asignación de sistemas de referencia. 
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De la asignación de sistemas de referencia anterior se obtiene la tabla 3.10, con los 
parámetros cinemáticos del manipulador. 


Tabla 3.10 Parámetros DH del robot RPP. 


p3ff90 ff %s fas ff 9 | 
[elo fo  ffZ. fo] 


A partir de la tabla 3.10, se obtienen las siguientes matrices de transformación del 
manipulador: 


E -s 0 0] =l 0.0.0] 
T® ee $1 Ci 0 0 TÌ} > 0 -1 0 0 
l o 0 Tgp 0 0 id 
E 0 Lo o 0 0 a | 
[9 -1 0 La | 1.0.0 o ] 
T? = |° 0 -1 md agan t 
3 10 0 NS 0.0 1 £. 
Lo o 0 | HR 


Empleando los datos anteriores, se calculan las matrices de transformación compues- 
tas: 


—C1 S1 0 0 
0 _ mimi -s51 -c 0 0 
Qena=! y 0 1 da 
0 0 Ww 1 

O cc -—si —£L3ci — sidz 

0 0m2 0 si a —L3s1 + c1d3 
dl da 
0 0 0 1 


0 cı -sı —L3ci — Los] — sidz 
0 si € -—L3sı + Leci + cidg 
1 0 0 də 
0 0 0 1 


Las matrices de transformación anteriores representan la descripción cinemática del 
manipulador. 
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Ejemplo 3.10 


Sea el robot manipulador PPP de la figura 3.28. Realizar las siguientes operaciones: 


1. Asignación de sistemas de referencia de acuerdo a la convención DH. 


2. Obtención de la tabla de parámetros de la convención DH. 


3. Cálculo de las matrices de transformación TP, T}, etc. 


Figura 3.28 Robot manipulador cartesiano. 


Solución 
El primer paso para resolver el problema consiste en determinar la asignación de 


los sistemas de referencia del manipulador, así como las distancias correspondientes, 
como se muestra en la figura 3.29. 
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Figura 3.29 Asignación de sistemas de referencia para robot PPP. 


A partir de la asignación mostrada en la figura 3.29, se obtiene la tabla 3.11, co- 
rrespondiente a los parámetros DH del manipulador PPP. 


Tabla 3.11 Tabla de parámetros DH para manipulador PPP. 


|i || aia || ai-1 || di || 0; | 
fo fo ia fo] 
| | 
| 


9 ||0 df o | 
|3 l| 90 fo _ ds [90 / 
ello [Ze fo |0 | 


o 


Empleando la tabla 3.11, se obtienen las matrices de transformación del manipulador 
como se indica a continuación: 


0 
Ti o 


Alfaomega Cinemática y Dinámica de Robots Manipuladores e Roger Miranda Colorado 


3.5 Problemas adicionales 119 


0 0 0 1 © 0O 0 1 


y a partir de las matrices de transformación anteriores se obtienen las matrices de 
transformación compuestas del manipulador: 


f -1 0 0 | 0 0 1 ds 
0 0 -1 —d; i 1 0 0 -—d; 
) opl 2 0 _ 02 — 2 
di 1 0 0 d Ta = TT 0 -1 0 d 
0 0 0 1 0 0 0 1 
| 0 0 1 dz | 
: -1 0 0 -d2- Le 
0 _ ry03 _ 2 € 
riak dl E E dı 
0 0 0 1 
con lo que se concluye el análisis cinemático del robot manipulador. 
Ejemplo 3.11 
Sea el robot manipulador RRP de la figura 3.30. Realizar las siguientes operaciones: 


1. Asignación de sistemas de referencia de acuerdo a la convención DH. 
2. Obtención de la tabla de parámetros de la convención DH. 


3. Cálculo de las matrices de transformación Tf, T}, etc. 


Figura 3.30 Robot manipulador RRP. 
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Solución 


Primero se determina la asignación de los sistemas de referencia del manipulador, así 
como las distancias correspondientes como se muestra en la figura 3.31. 


Figura 3.31 Asignación de sistemas de referencia para manipulador RRP. 


A partir de la asignación mostrada en la figura 3.31, se obtiene la tabla 3.12 con los 
parámetros DH del manipulador. 


Tabla 3.12 Tabla de parámetros DH para el manipulador RRP. 


Empleando la tabla 3.12, se obtienen las matrices de transformación del manipulador 
como se indica a continuación: 


ca —-3, 0 0 co -3 O Lz 
o_|s a 0.0 1 |s ca 0 0 
Selg 4 4 Lı ll E y a Loa 
0 0 0 1 0 0 0 1 
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1.0.0 Ls | p10.0 0] 
5 1.0.0 A 010 0 
Telg o a a be="loo1b 
0.0.0 y] looo 1] 


Empleando las matrices de transformación anteriores, se obtienen las matrices de 
transformación compuestas del manipulador: 


| C1 =s] 0 0 | | Ca —89 0 Lo 
o _ wrn a a 4 y s2 4 0 0 
N = h= 0 0 1 Li 0 0 1 La 
0 0 O 4 0 0 0 1 
C12 —812 0 Loc; 
$12 C12 0 Los; 
0 0 1 Li+ Loa 
0 0 0 1 
| Ci —$12 0 Loci 1 0 0 L3 
o 0m2 si &2 0 Losi 0 -1 0 0 
Eg = a 0 0 1 Li+tLa 0 0 -1 -dz 
0 0 0 1 0 0 0 1 | 
cr s2 0 L2ci+L3c1 
mn sí -Ci2 0 L2si+L3s12 
0 0 1 Li + La — d3 
0 0 0 1 
C12 $12 0 Lac1 + L3c12 100.0 ] 
WO s m3 _ | $512 =>2 0 Los; +L3s12 010 0 
Te g TiTe z 0 0 —1 L; + Loa me dy 0 0 1 La 
0 0 0 1 0.00 1 


ci s2 0 Lac, + L3c12 
s12 -C12 0 L281 + L3s12 
e 0 0  -1 Li+ La- dz- Le 
0 0 0 1 


con lo que se concluye el análisis cinemático del robot manipulador. 
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En esta Unidad se han proporcionado las herramientas básicas para el análisis ci- 
nemático de un robot manipulador. Se estudiaron los conceptos referentes a la asig- 
nación de sistemas de coordenadas empleando la convención de Denavit-Hartenberg 
y la forma en que es posible obtener las matrices de transformación homogénea para 
cualquier robot manipulador. 


Es importante notar que, una vez que se conocen las matrices de transformación 
homogénea de un robot manipulador, es posible determinar las relaciones cinemáticas 
existentes entre cualquier sistema de coordenadas que se asigne al robot y así realizar 
cálculos que involucren sólo posiciones del manipulador, como se verá en el análisis 
del Jacobiano del manipulador. 


En general, el proceso se comienza a volver más interesante cuando, a partir del 
análisis cinemático establecido en esta Unidad, se pueden determinar relaciones que 
involucren las velocidades del manipulador. Los conceptos de velocidades, junto con 
los de aceleraciones que se estudiarán más adelante, son muy importantes debido a 
que, cuando se trata el problema de control de un manipulador, a menudo se está 
interesado no solo en que el robot llegue a una cierta posición, sino que se aproxime 
a ella con un cierto perfil de velocidades que pueda ajustarse de acuerdo a las necesi- 
dades del operador. En dichos casos, los datos obtenidos de la cinemática directa del 
manipulador se vuelven relevantes, especialmente en el proceso mediante el cual se 
obtienen las ecuaciones dinámicas del manipulador. 


3.1 Defina el concepto de cinemática directa para un robot manipulador. 


3.2 ¿Los sistemas de referencia se asignan a una articulación o a un eslabón de un 
robot? 


3.3 Explique cuál es la interpretación que se le da a los parámetros a;_1, 0-1, di y bi. 


3.4 ¿Cuáles parámetros son constantes y cuáles son variables en la convención DH si 
la articulación considerada es prismática? 


3.5 ¿Cuáles parámetros son constantes y cuáles son variables en la convención DH si 
la articulación considerada es rotacional? 
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3.6 Indique cuál es la matriz de transformación homogénea general > de acuerdo 
a la convención DH. 


3.7 Sea el robot manipulador PRPR de la figura 3.32. Realizar las siguientes opera- 
ciones: 


1. Asignación de sistemas de referencia. 
2. Obtención de la tabla de parámetros de la convención DH. 


3. Cálculo de las matrices de transformación Tf, Tå, etc. 


Figura 3.32 Robot manipulador del ejercicio 3.7. 


3.8 Sea el robot manipulador RR de la figura 3.33. Realizar las siguientes operaciones: 


1. Asignación de sistemas de referencia de acuerdo a la convención DH. 
2. Obtención de la tabla de parámetros de la convención DH. 


3. Cálculo de las matrices de transformación Ty, T4, etc. 
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Figura 3.33 Robot manipulador del ejercicio 3.8. 


3.9 Sea el robot manipulador RRRP de la fig. 3.34 [12]. Realizar las siguientes opera- 
ciones: 


1. Asignación de sistemas de referencia de acuerdo a la convención DH. 
2. Obtención de la tabla de parámetros de la convención DH. 


3. Cálculo de las matrices de transformación Ts TX, etc. 


Figura 3.34 Robot manipulador del ejercicio 3.9. 


3.10 Diseñe un programa en Matlab-Simulink que realice las siguientes operaciones 
para un robot manipulador planar de 2 GDL: 


1. Subsistema que calcule la cinemática directa del efector final del robot mani- 
pulador. 
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2. Proporcionar una trayectoria del robot por medio de un conjunto de ángulos de 
las articulaciones y obtener la gráfica que muestre en el plano xy la evolución 
del efector final y un elemento que despliegue el valor numérico de la posición y 
orientación del efector final de acuerdo a los cálculos de su cinemática directa. 


3.11 Disene un programa en Matlab-Simulink que realice las siguientes operaciones 
para un robot manipulador de 3 GDL no planar: 


1. Subsistema que calcule la cinemática directa del efector final del robot mani- 
pulador. 


2. Proporcionar una trayectoria al robot manipulador por medio de un conjunto 
de ángulos de las articulaciones y obtener la gráfica en 3D del movimiento del 
efector final del robot empleando Matlab. 
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Es evidente que la ciencia de la naturaleza versa casi toda ella 
sobre los cuerpos y las magnitudes y sobre sus propiedades y 
movimientos, así como sobre todos los principios de esta clase 
de entidades. 


Aristóteles 


Hasta el momento se ha realizado el análisis de cinemática directa de robots mani- 
puladores. Como se ha mencionado, dichas ecuaciones permiten establecer un mapeo 
o relación entre el conjunto de variables de las articulaciones con el conjunto de va- 
riables del efector final, es decir, sus posiciones y orientaciones. Sin embargo, éste no 
más que un primer paso en el estudio de los robots manipuladores. El siguiente 
paso para el manejo de dichas ecuaciones viene a la mente cuando se piensa en un 
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manipulador simple, por ejemplo, un robot que realice la tarea de pulir una superficie 
determinada. En éste caso no sólo es necesario que el robot se aproxime a la superficie 
que se desea pulir, sino que en el momento en que el efector final del robot llegue a 
dicha superficie lo haga con una velocidad cero, ya que de no ser así pudiera existir un 
sobretiro en el robot que danaría la superficie a pulir e incluso podría dañar al robot. 
En dichos casos no solo se tiene interés en aspectos relacionados con la posición del 
efector final, sino también con las velocidades involucradas en el proceso. 


Por otra parte, cuando se quiere controlar un robot, es importante contar con un 
análisis de las denominadas ecuaciones dinámicas del manipulador, ya que en ellas in- 
tervienen no solo la posición, sino también las velocidades y aceleraciones. Por lo tanto, 
es importante realizar en primera instancia un análisis de los robots manipuladores 
en el cual se estudien las propiedades del mismo relacionadas con las velocidades del 
efector final y de cualquier punto de dicho manipulador. De modo específico, es en 
dicho análisis donde aparece un concepto fundamental que se denomina Jacobiano 
del manipulador. 


El Jacobiano del manipulador es una herramienta matemática que permite estable- 
cer una relación entre las velocidades de las articulaciones con las velocidades lineales 
y angulares del efector final. El Jacobiano es una matriz que, desde el punto de vista 
matemático, puede verse como una transformación de espacios. Se le puede considerar 
como la versión vectorial de la derivada normal de una cierta función y su importancia 
radica en su amplia variedad de aplicaciones, entre las que se encuentran: planeación 
de trayectorias del manipulador, obtención de las ecuaciones dinámicas del robot ma- 
nipulador empleando las denominadas ecuaciones de Euler-Lagrange, relación entre 
las fuerzas y pares del manipulador, etc. 


El análisis que se desarrollará en esta Unidad incluye el estudio de las velocidades 
lineales y angulares de un cuerpo rígido y, a partir de dicho análisis, se establecerá 
una metodología para obtener el Jacobiano del manipulador. Además, se estudiarán 
algunos ejemplos de aplicación del Jacobiano del manipulador, mostrando cómo a 
partir de su conocimiento es posible establecer un método para comenzar a controlar 
un robot. A lo largo del Capítulo se irán introduciendo los elementos matemáticos 
necesarios antes de que se presente su aplicación en el análisis a desarrollar. Se re- 
comienda el estudio detallado de dichos temas y su comprensión para poder entender 
claramente la aplicación de los mismos en la determinación del Jacobiano del manipu- 
lador y, posteriormente, en la determinación de las ecuaciones dinámicas de un robot 
manipulador de cadena cinemática abierta. 


4.2 Matrices Antisimétricas 


En esta Unidad se emplearán las denominadas matrices antisimétricas en una gran 
cantidad de cálculos, por lo que su introducción y el estudio de sus propiedades es de 
gran importancia. A continuación se indica la definición de dichas matrices. 
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Matriz Antisimétrica 


Una matriz S € R”*” se dice que es antisimétrica si y solo si: 


sT+8=0 (4.1) 


Sean s;j, {i,j} = 1,2,3, los componentes de S. Entonces, la ecuación (4.1) es equiva- 
lente a las siguientes nueve ecuaciones: 


Sij + Sji = 0, 55% = j ye 


donde s;; = O para todo į = 1,2,3, es decir, los términos diagonales de S son cero. 
Los elementos fuera de la diagonal, descritos por sij con i # j, satisfacen la siguiente 
relación: si; = —sji. Por lo tanto, S contiene solo tres entradas independientes. De 
esta manera, empleando únicamente los elementos s4, $2, $3, toda matriz antisimétrica 
S € IR* puede escribirse empleando la siguiente estructura: 


0 —s3 s2 
g= 33 0 21 (4.2) 
—$82 $1 0 


e de » o. . 
Dado el vector a = [az, ay, a+} . es posible definir la matriz S (a) = Sa. que representa 
a la matriz antisimétrica S parametrizada por el vector a, es decir: 


0 =ü; Ay 
Sasa] a, 0 -as (4.3) 
dy Qz 0 


El acomodo de los elementos a+, ay, a, en (4.3) es importante debido a que la expresión 
Sa se emplea para realizar la operación producto cruz o producto vectorial (a x b) 


por medio de la operación Sab = a x b. Debido a esto, el operador Sa usualmente se 
denomina operador producto cruz. 


Ejemplo 4.1 


A partir de los vectores unitarios {i,j,k} es posible obtener las siguientes matrices 
antisimétricas: 


po 0 o |] 
S(i=|0 0 -1 S(i)=| 0 00 
I =] 


—a 
_ 
=> 
— 
= 
— 

AS ] 


ssl v ol 
(k) o | 
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4.2.1 Propiedades de las matrices antisimétricas 


Las matrices antisimétricas poseen un conjunto de propiedades que serán útiles en los 
desarrollos posteriores. Por lo tanto, dichas propiedades se incluyen a continuación 


[1]. 
Propiedad 1. El operador § (-) es lineal, es decir: 
S (ax + By) = aS (x) + BS (y) (4.4) 
para cualesquiera vectores x,y € R? y escalares a, 8 € R. 


Propiedad 2. Dada la matriz de rotación R y los vectores x, y € IR?, se cumple que: 


RÍ[x x y] = Rx x Ry (4.5) 


Para la siguiente propiedad, sean los vectores x,y € IR?, donde x = [21,22,23)*, 
T 
y = [y1;Y2,y3] . Entonces, el producto S(x)y es: 


| 0 -z3 T2 ] Y | T2Y3 — T3Y2 ] 
S(x)y =} 23 0 -z Y2 j} = | -71Y3+Y1T3 
| -T2 Tı 0 ] | Ya ] | T1Y2 — T241 ] 


mientras que el producto cruz entre x e y es: 


i j k T2Y3 — T3Y2 
xxy=det| zı T2 T3 | = | —-11Y3+Y173 
y Y2 Y3 T1Y2 — T241 


Con base en las expresiones anteriores se formula la Propiedad 3. 


Propiedad 3. Sean los vectores x,y € RË, con x = [21.12,13)",y = [y1, y2, y3)". 
Entonces: 


S()y=%y=xxy (4.6) 
Debido a (4.6), al operador Se =S (x) se le denomina operador producto cruz. 
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Ahora, dados los vectores x,y € IR*, la matriz de rotación R y la matriz anti- 
simétrica S(x), se cumple que: 
RS(x)R"y = R[xxR”y) 
= [Rx] x [RR y] 
Rxx y 
= S(Rx)y 


Empleando el resultado anterior se obtiene la siguiente propiedad. 


Propiedad 4. Dada la matriz de rotación R y el vector x € R*, se cumple la igual- 
dad: 
RS (x) RT = S (Rx) (4.7) 


La ecuación (4.7) es una de las aplicaciones más útiles de las matrices antisimétri- 
cas. Nótese que el lado izquierdo de (4.7) representa la transformación de similaridad 
de S (x). Entonces, una posible interpretación de (4.7) es la siguiente: la representación 
matricial de S (x) en un sistema de referencia rotado por R es equivalente a la matriz 
antisimétrica S (Rx) parametrizada por el vector x rotado por R. Dicha expresión 
será de gran importancia más adelante cuando se estudie la expresión del Jacobiano 
en el efector final. 


Una de las operaciones de mayor importancia para el análisis que se desarrollará más 
adelante es el de la derivada de las matrices de rotación. Su primera aplicación impor- 
tante se encuentra en el estudio de las velocidades angulares y lineales de mecanismos 
compuestos por múltiples cuerpos rígidos. 


Sea la matriz de rotación R (0). Debido a que R es ortogonal, es claro que: 


R (0) RT (0) =1 (4.8) 


Derivando ambos lados de (4.8) con respecto a ĝ se obtiene: 


dR y , ¿dr? 
Defínanse las siguientes matrices: 
S= En ST = p (4.10) 
-— A i 
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Empleando la definición de S en (4.10) se obtiene: 


dis, ¿ER pa 


lo cual implica que S es una matriz antisimétrica. 


La derivada de R con respecto a ĝ se obtiene al multiplicar por el lado derecho la 
ecuación de S en (4.10) por la matriz R, es decir: 


Ss d T 
SR(0) = qg OR (0)R(0) 
por lo tanto: 


dR (0) 
E Di SR (0) (4.11) 
Ejemplo 42 


Sea la matriz de rotación con respecto al eje z: 


m co —S0 o | 
ig Tai 


Empleando (4.10) se construye la siguiente matriz antisimétrica: 


dR —=8ọ9 —Cp 0 Co So 0 0 -1 0 
S= E = Co =sg O =-=% Cog 0 | = 1 0 0 
0 0 0 0 0 1 0 0 0 


En el cálculo anterior se observa que S = S (k), por lo que la derivada de Rz. con 
respecto a 0 puede escribirse como: 


dRz o 
dð 
es decir, la derivada es la misma matriz premultiplicada por la matriz antisimétrica 
parametrizada por el vector unitario correspondiente al eje de rotación. Para los ejes 
x,y se obtienen relaciones similares, como se indica a continuación: 


= S (k) Rz.o 


dRx.0 


B7 = i (i) Rx.o (4.12) 
dRy.o 
2 = S (À) Rys 
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4.4 Teorema de Euler 


Hasta el momento se han mencionado diferentes aspectos que se relacionan con los 
robots manipuladores, los cuales están compuestos de articulaciones y eslabones o 
cuerpos rígidos. El concepto de cuerpo rígido es importante, así como la descripción 
de sus propiedades de movimiento. 


A continuación se presenta la definición de cuerpo rígido, así como el denomina- 
do Teorema de Euler. Se mostrará la obtención de dicho teorema desde el punto de 
vista geométrico y matemático, ya que ambos enfoques proporcionan un mejor en- 
tendimiento del concepto de velocidad angular que será empleado en la obtención del 
Jacobiano del manipulador. 


Considérese un cuerpo en R? como se muestra en la figura 4.1. El conjunto C con- 
tiene a todos los puntos que constituyen el cuerpo. Sean A, B dos puntos cualesquiera 
del cuerpo. Considerando el sistema de referencia mostrado, los vectores rą, rg re- 
presentan la ubicación de A, B, respectivamente, en relación al sistema de referencia 
dado. Ahora se procede a definir un cuerpo rígido. 


Y 


Figura 4.1 Diagrama de un cuerpo rígido. 


Cuerpo Rígido 


El conjunto C C R? se denomina cuerpo rígido si para dos 
puntos cualesquiera A, B € C se satisface la siguiente expre- 
sión: 


lra (t) — ra (t)l| = constante (4.13) 
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La definición anterior indica que, dados dos puntos cualesquiera A, B de un cuerpo 
rígido, la distancia de dichos puntos no debe de cambiar en el tiempo, es decir, el 
cuerpo no sufre ninguna deformación. Lo anterior corresponde a la idea intuitiva de 
que un cuerpo rígido no presenta ningún tipo de flexibilidad. En la realidad todos 
los cuerpos presentan un cierto grado de flexibilidad, pero puede considerarse que un 
cuerpo es rígido cuando las deformaciones que éste experimenta son tan pequeñas que 
pueden despreciarse para la aplicación que se esté tratando. 


4.4.1 Teorema de Euler: punto de vista geométrico 


Si se considera un punto fijo O” perteneciente al cuerpo rígido C mostrado en la figura 
4.2, puede emplearse una definición alternativa a (4.13) para referirse a un cuerpo 
rígido. Para ello, sea A un punto arbitrario de C. Entonces, es posible establecer la 
definición matemática de un cuerpo rígido por medio de la siguiente igualdad: 


lra (t) | = constante (4.14) 


que es equivalente a la definición dada en (4.13). 


y 


Figura 4.2 Diagrama de un cuerpo rígido con punto fijo. 
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Teorema de Euler (Leonard Euler) 


Considérese un cuerpo rígido C y un punto fijo O” del cuerpo. Sea un 
sistema de referencia arbitrario, cuyo origen coincide con el punto fijo 
O”, como se muestra en la figura 4.3. 

Supóngase que el cuerpo se encuentra rotando y su vector de veloci- 
dad angular es w (t). Entonces, el punto arbitrario A € C se representa 
por medio del vector de posición ra y la velocidad lineal del punto A, 
representada por V4, es: 


) 


= [w (t), ra (t)] 


donde el vector w (t) no depende del punto A € C y [-,-] denota la 
operación producto cruz. La ecuación (4.15) se conoce como Fórmula 


de Euler |8, 7, 12]. 


Figura 4.3 Diagrama de un cuerpo rígido C con punto fijo O’ en el origen de un 
sistema de coordenadas. 
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Demostración 


Sea A un punto fijo del cuerpo rígido y ra (t) su vector de posición. Como 
se trata de un cuerpo rígido, se debe de cumplir la siguiente expresión: 


llra (t)i = constante 


lo cual indica que el producto punto rra = (ra (t) ra (t)) es constante 
para cualquier tiempo t. Derivando el producto escalar anterior se ob- 
tiene: 


E (ra (0 ora (0) =2 (Gra (0) ra(0)) =0 
lo cual implica que el vector de posición ra (t) y su derivada temporal 
dra(t)/dt son ortogonales. Entonces, debe de existir un vector wa (el 
subíndice A se incluye suponiendo que dicho vector pudiera depender 
del punto A elegido, aunque más adelante se demostrará que wa es in- 
dependiente del punto que se elija), tal que la ecuación de Euler (4.15) 
queda demostrada, es decir: 


Los vectores wa. ra pueden expresarse empleando sus componentes como 
se indica a continuación: 


WA wWa,1+wa,j+wa,K 
Ta zai + yaj + zak 


donde TA. Ya, Za son constantes en el tiempo, dado que A es un punto 
fijo. 

Ahora debe mostrarse que el vector w4 puede expresarse como w, debido 
a que no depende del punto A elegido. Considérese la derivada del vector 
de posición del punto A, rą (t), expresada de la siguiente manera: 


d 


d d, d, 
u^ (t) = za qa t Yagi t ZA u“ (4.16) 
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Desarrollando la expresión (4.16) se obtiene: 


koara] = [(w.a, i +wa,j + wa,k) „(zai + yaj + zak)] 


(wa, i, (£ai + yaj + 24k)] + 

[wa,j, (xai + yaj + 24k)] + (wa,k, (xai + yaj + 24k)] 
WA,YA fi, j] + WA, ZA li, k] + WA, TA (3,1) + WA, ZA Íj, k] + 
WA,TA [k, i] +WA.YA [k,j] 

WA YAK — WA,ZAj — wa,TAk + wa,zai + wa. Taj — wa, yai 
za (wa,j— wak) + ya (wa, k — wa, i) + za (wa, i— waj) 


y, comparando la expresión anterior con (4.16), se obtienen las siguientes 


relaciones: 3 
pi = waj — wak = [wa, i] 
Aj = wa,k - wa, i = wa, j] (4.17) 


$k — WA,l e WA.) — [wa, k] 


Multiplicando vectorialmente la primera ecuación en (4.17) por k se 
obtiene: 


d 
|x. sil = [k,wa,j-wa,k] = —wa, i 


Al multiplicar la expresión anterior por i se obtiene la expresión final de 


WA.: 
4 d, 
- (lio) = 


En la expresión anterior se observa que wa, no contiene ninguna com- 
ponente del punto A, es decir, no depende del punto A. Entonces se 
reescribe wa, de la siguiente manera: 


Siguiendo un procedimiento similar se obtiene: 


d 
E al = [i wa, k ami wa, i] = —WA.,) 
dt 


TE) 
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[j wa, i em wa.) = —wa, k 


- (e 72) 


es decir, el vector w no depende del punto A elegido y la prueba se 
concluye. 


4.4.2 Teorema de Euler: punto de vista matemático 


Considérese un punto fijo p de un cuerpo rígido C expresado de manera relativa a un 
sistema de referencia {B}. Se supone que {B} se encuentra fijo al cuerpo rígido C. 
La ubicación de p se proporciona por medio del vector fijo r”. Considérese ahora un 
sistema de referencia (A). Los sistemas de referencia (A) y {B} pueden relacionarse 
por medio de la matriz de rotación Rf. Entonces se obtiene: 


rf = Rr” 


donde rê representa la ubicación de p con respecto a {A}. 


Si {B} rota de manera relativa a {A}, i.e. RĀ # 0, entonces la derivada con respecto al 
tiempo del vector de posición r^, denotada por Fa, se expresa de la siguiente manera: 


-1 , 
por lo que empleando r? = [Rf] r^ se obtiene: 


H = vå = R4 [REI r^ = AGRO 
o bien, empleando (4.10) se obtiene: 
vå = sir? (4.18) 


donde Si = RA [RA]” es una matriz antisimétrica denominada matriz de veloci- 


T ó 
dad angular. Sea el vector wå = [wr, Wy: Wz] , entonces la ecuación (4.18) puede 
expresarse de la siguiente manera: 
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El vector wi! se denomina vector de velocidad angular, y representa la velocidad 
angular del sistema de referencia {B} expresada con respecto al sistema de referencia 
{A}. Además, la ecuación (4.18) puede escribirse como: 


vå = wi xr? (4.19) 


que es la forma usual del teorema de Euler. De esta manera se ha concluido que existe 
un vector wå tal que (4.19) es válida y dicho vector puede obtenerse por diferenciación 
directa como se indica a continuación [1]. 


Sea la matriz de rotación R. La derivada de R con respecto al tiempo se obtiene 
por definición de la siguiente manera: 


R= lim R(t+ At) - R(t) 
At=>0 At 


La matriz R(t + At) puede expresarse como: 
R(t + At) = Rx,aoR (t) 


para un cierto vector unitario arbitrario k y la matriz de rotación con respecto a un 
eje arbitrario Rx ap. Por lo tanto: 


sa [Rd ji fear 
R= gm, [ER] = Jm, [E] Reo 


En el análisis de parametrización de matrices de rotación con respecto a un eje arbi- 
trario se vió que la matriz de rotación correspondiente a dicha parametrización es: 


k2vo + co krkyvo — kzsg krkzvo + kyso 
Rko = kzkyvo + k.sg kivo + Co kyk:vo — k.S9 
| ksk:V0 sin kys kykzvo T krs k2vg + co | 


por lo que: 


k? UAO + CAo krkyvao —k.sao Krk:vA0 + k,SA0 
krkyvao + a kóvao + CA0 kyk:vao — kasao | — I 
kek:VA0 — 'ySA0 k yk:VAO + K:SA0 kvaso + CA0 


Rk,ao- I = | 
A 0+1  0-k,A0 0+k,A0 
Li 
| 
| 


0+k,¿A0 0+1  0-%,A0 |--I 
0—k,A0 04+k,A0 0+1 | 


0  —k¿A0 k,A0 
k.A0 0 —k,A0 
—k,A0 k,A0 0 | 


entonces: 
1 0 —k¿A0  k,A0 
R= lim a k.A0 0 —k., A0 R (t) 
aditi -k,A0 k,A0 0 
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de donde se obtiene finalmente: 
| 0 =k: k, ] 
R= k0 0 -kz0 | R(t) 
| =ky0 k0 0 ] 
y, multiplicando la expresión anterior por el lado derecho por R(t) se obtiene: 
| 0  —k:0 k, 
RR*=|¡ kð 0  —kz0 
| —k,0 k0 0 | 


A 


Entonces, considerando (4.19), dado que ví = wi xr4=S (wå) rê, se concluye que 


S (wf) = RR7?, donde: 


ka k,ĝ l 
k= | ky | ,058=| £,0 | =0k 
kz k.0 


El análisis anterior implica que el cambio de orientación de un sistema de referencia 
en rotación puede verse como una rotación con respecto a un eje arbitrario k en un 
ángulo 0. 

De acuerdo a los cálculos anteriores, el vector de velocidad angular wi depende de 
Å, lo cual indica que 0 depende del tiempo, al igual que el vector de velocidad angular 
y la matriz de rotación RE. Por lo tanto, la derivada con respecto al tiempo de RÅ (t) 
se puede expresar como: 


R5 (t) = S (w6 (t)) RE (t) (4.20) 


Ejemplo 4.3 


Empleando la matriz de rotación R (t) = R, ot), su derivada con respecto al tiempo 
se calcula de la siguiente manera: 


È = —=>>—=S(k)R(1)6 


= S (ók) RŒ) =S(w(t)) R(t) 


donde w (t) = Êk es el vector de velocidad angular con magnitud 0. Nótese que, como 
la rotación se efectúa con respecto al eje z, es natural que el vector w(t) esté en función 
del vector unitario k, el cual indica la orientación de w(t). De la misma manera, las 
derivadas con respecto al tiempo de las matrices Rx 0(1). Ry o(1) son: 


Rio) =S (0) Rx ot): Ry 01) = S (4) Ry ot) 
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4.5 Cálculo de velocidad lineal y angular total 


Una vez estudiados los conceptos de matrices antisimétricas, cuerpo rígido y teorema 
de Euler, es posible comenzar con el análisis de velocidades que permitirá determinar 
el Jacobiano del manipulador. 


4.5.1 Velocidad lineal con orientación constante 


Sea el sistema de referencia {B} unido a un cuerpo rígido que experimenta movimien- 
tos de traslación sin cambios en su orientación, es decir, Rå es constante. Sea r? el 
vector que describe un punto p de dicho cuerpo expresado en el sistema {B}. Dado 
el sistema de referencia fijo {A}, se busca describir el movimiento de r” expresado 
en (A). Nótese que el movimiento lineal del punto p relativo a (A) se debe a los 
desplazamientos lineales del origen del sistema {B}, o, o del punto expresado por 
rë (variante en el tiempo), pero no por cambios en la orientación de {B}. De esta 
manera, la velocidad lineal del punto p en {A} se expresa de la siguiente manera: 


v? = vé + Rvp (4.21) 


donde v$ = sof = 6%, representa la velocidad del origen de {B} con respecto al 
sistema de referencia [A], y vë es la velocidad lineal de p en {B}, como se observa 


en la figura 4.4. 


lg 


Figura 4.4 Sistemas de referencia {A} y {B} con orígenes no coincidentes y orientación relativa 
constante. 
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4.5.2 Velocidad lineal inducida por rotaciones 


Ahora se mostrará que los movimientos rotacionales inducen una velocidad lineal en 
un cuerpo rígido. Para ello se emplean los sistemas de referencia {A} y {B}, los cuales 
coinciden en el origen. Se supone que {B} se encuentra unido a un cuerpo rígido que 
rota de manera relativa a {A}. 


De acuerdo al análisis anterior, la velocidad angular del cuerpo con respecto al 
sistema de referencia {A} se describe por medio del vector de velocidad angular wå. 


Sea p un punto del cuerpo rígido y r? su vector de posición expresado en {B}. En 
la figura 4.5 se ilustra el comportamiento de la trayectoria que describe dicho punto al 
rotar con respecto al eje donde se ubica Wi. Éste movimiento se observa con respecto 
al sistema de referencia {A} en los instantes de tiempo t y t + At. 


Figura 4.5 Velocidad lineal de un punto debida a un movimiento rotacional. 


Nótese que sin 0 = ||r|| / hr4 11, donde r^ es el vector de posición del punto expresado 
en el sistema de referencia {A} y ||r|| es la magnitud del radio de giro. Entonces, 
rl] = r4 || sin 0. Considerando un movimiento infinitesimal, el ángulo que se desplaza 
el punto en un tiempo At puede expresarse como: 


s= lug] ac 


por lo que la longitud de arco puede considerarse como el valor [|Arl| y es posible 
obtener la siguiente expresión: 


| Arl| 


t A AA 
les at IIr4 || sin 0 


De la expresión anterior es claro que: 
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[Ar] 


a” lwll lle“ sin 0 (4.22) 


y, calculando el límite cuando el incremento del tiempo A(t) tiende a cero, se obtiene: 


A 
r 


vå =wf x r? (4.23) 
es decir, se llega nuevamente a una forma alternativa para demostrar el Teorema de 
Euler, mostrándose la contribución del vector de velocidad angular a la velocidad 


lineal de un punto del cuerpo rígido. 


De acuerdo al resultado anterior, cuando un cuerpo rígido se encuentra rotando 
con una cierta velocidad angular w, experimentará en cada uno de sus puntos una 
velocidad lineal debida a los efectos de dicha rotación. Como consecuencia del Teorema 
de Euler se tiene que: 


Li = [wi] 
ql = lo. (4.24) 
K = w, k] 


Considérese el vector r y el vector unitario en la dirección de r denotado por e, = r/r, 
donde r = ||r||, por lo que r = rep. Supóngase que r no es constante, por lo que su 
magnitud varía con respecto al tiempo, entonces: 


—r = er + r—e 
dt e 


y, empleando el Teorema de Euler, se obtiene: 


e, 
dt 


Fer +r [w, er] 


Fer + (w, r] 


De la expresión anterior se concluye, como consecuencia del teorema de Euler, que la 
derivada de un vector de posición r puede expresarse como: 


E e NN) (4.25) 
dt r 

Cuando un cuerpo rígido experimenta una rotación pura con respecto a un eje fijo, 
todo punto del cuerpo se mueve alrededor de un círculo, y los centros de dichos círculos 
se encuentran a lo largo del eje de rotación. Si se traza una línea perpendicular de 
cualquier punto de dicho cuerpo al eje de rotación, al transcurrir el tiempo dicha línea 
describirá un arco con un ángulo 6; este ángulo es el mismo para cualquier punto 
del cuerpo. Si k es un vector unitario en la dirección del eje de rotación, entonces la 
velocidad angular del cuerpo rígido puede expresarse mediante: 


w = Êk (4.26) 
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donde Ú es la derivada con respecto al tiempo de 9. Empleando el Teorema de Euler 
se sabe que: 
V=WwXTHÍ (4.27) 


El vector r representa la posición de algún punto del cuerpo rígido con respecto a 
un sistema de referencia arbitrario, el cual tiene su origen en algún lugar a lo largo 
del eje de rotación. Entonces, se concluye que la velocidad angular induce velocidades 
lineales en cada uno de los puntos de un cuerpo rígido. 


De acuerdo a la ecuación (4.26) y lo analizado en el Teorema de Euler, todos 
los puntos de un cuerpo rígido en rotación presentan la misma velocidad angular 
(cada punto recorre el mismo ángulo 0 en un intervalo de tiempo dado), por lo que 
la velocidad angular es una propiedad del cuerpo rígido en rotación, y no es una 
propiedad de puntos individuales. Por otra parte, los puntos individuales pueden 
experimentar una velocidad lineal inducida por el movimiento rotacional, pero no es 
correcto referirse a la velocidad angular de un punto. 


4.5.3 Velocidad lineal total 


Si se considera que un cuerpo rígido experimenta movimientos de rotación y traslación, 
se pueden combinar los resultados anteriores de velocidad lineal sin cambio de orien- 
tación y velocidad lineal inducida, es decir, las fórmulas (4.21) y (4.23), para obtener 
la expresión de la velocidad lineal total vá del punto p, expresada en el sistema de 
referencia {A}: 


ví = ò + Ráv? +w$ x r? (4.28) 


donde: 


a 05: denota la velocidad lineal del origen del sistema de referencia {B}, expresada 
en el sistema de referencia {A} 


a vë: denota la velocidad lineal del punto p del cuerpo, expresada en el sistema 
de referencia {B} 


a r?: denota la posición del punto p del cuerpo, expresada con respecto al sistema 
de referencia {A} 


La ecuación (4.28) indica que cuando se tiene un cierto punto en movimiento en un 
sistema de coordenadas y se quiere determinar la velocidad lineal de dicho punto 
con respecto a otro sistema de coordenadas con origen y orientación diferentes, la 
velocidad lineal contará con tres términos que indican la velocidad de movimiento 
del origen del segundo sistema de referencia, la velocidad de movimiento del punto 
considerado en el segundo sistema de referencia y la velocidad lineal inducida por el 
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movimiento rotacional del segundo sistema de referencia con respecto al sistema de 
referencia base. 


4.5.4 Velocidad angular total 


Cuando un cuerpo rígido se encuentra rotando con respecto a un eje en un sistema de 
referencia, y éste a su vez se encuentra rotando con respecto a otro eje relacionado con 
otro sistema de referencia, y así sucesivamente, es importante hallar una metodología 
para determinar un vector de velocidad angular total debido a la combinación de todas 
las rotaciones, expresando todo con respecto a un sistema de referencia particular. 


Se inciará el análisis suponiendo que se tienen tres sistemas de referencia: {0}, (1) y 
{2}. Se considera que los sistemas de referencia (1), (2) rotan con respecto al sistema 
de referencia fijo (0). Las orientaciones relativas de los sistemas de referencia (1) y 
{2} están dadas por las matrices de rotación R? (t) y R} (t). La orientación del sistema 
de referencia (2) con respecto al sistema de referencia {0} es: 


R3 (t) = Ri (t) Ra (t) (4.29) 
Derivando ambos lados de (4.29) con respecto al tiempo se obtiene: 
R9 (t) = R (t) R} (t) + RÌ (t) R} (t) (4.30) 
De acuerdo a (4.20), se puede expresar el término RÌ (t) de la siguiente manera: 
R3 (t) = S (w3) R2 (4.31) 
Por otra parte, el primer término del lado derecho de (4.30) puede expresarse como: 
Ri (t) R3 (t) = S (w1) RIR; = S (w1) R (4.32) 


Usando la propiedad (4.7), y las propiedades de las matrices de rotación en el segundo 
término del lado derecho de (4.30), se obtiene: 


ROS (wt) R} = ROS (w!) UN RR 
S (R?w1) RÌR} = S (R%wl) R} 


0 pl 
RiR 


Finalmente, combinando los resultados anteriores se concluye que: 
S (w3) R3 = [S (w1) R3 + S (Riwz)] R2 


y, empleando la propiedad de linealidad de las matrices antisimétricas S (a) + S (b) = 
S (a + b), se obtiene la expresión: 


wS = w + Rw (4.33) 
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que indica que las velocidades angulares pueden sumarse una vez que se expresan 
en relación al mismo sistema de referencia. Por lo tanto, si se tienen n sistemas de 
referencia y la matriz de rotación R que determina la orientación relativa de {j} con 


y el vector w? 


] „n Se expresa de la siguiente 


respecto a {i}, entonces R? = S(w?)R?, 
manera: 


w? =w? + Riw + Riwi + Riwi +... + R? w2? (4.34) 


Por lo tanto, cuando un cuerpo rígido experimenta múltiples rotaciones, su velocidad 
angular resultante consistirá en la suma de cada una de las velocidades angulares 
correspondientes a cada rotación, siempre que dichas velocidades angulares sean ex- 
presadas en un mismo sistema de referencia. 


4.6 Velocidad lineal y angular en robots manipuladores 


El objetivo del siguiente análisis será obtener un conjunto de ecuaciones que permitan 
determinar la velocidad lineal y angular del efector final de un robot manipulador. 
Nótese que, en general, se consideran robots manipuladores cuya base es fija. SI se 
asigna el sistema de referencia {0} a dicha base, es claro que los vectores vf, w9 serán 
ambos cero, donde v8, w? corresponden a la velocidad lineal y angular del eslabón 0. 
Entonces, el método a desarrollar consistirá en buscar un conjunto de fórmulas que 
permitan calcular primero la velocidad lineal y angular del eslabón 1, usando la infor- 
mación proveniente del eslabón 0. Luego seguir con el eslabón 2, y así sucesivamente 


hasta llegar al efector final. 


La razón de buscar un análisis de éste tipo es que se pueden determinar las veloci- 
dades en cualquier parte del robot, y no solo en el efector final. Sin embargo, lo más 
importante se verá cuando se muestre que el Jacobiano del robot manipulador puede 
obtenerse a partir de una factorización de un vector en IR* formado únicamente por 
los vectores de velocidad lineal y angular. 


Cuando se estudió la cinemática directa de los manipuladores se indicó que a cada 
eslabón se le puede asignar un sistema de coordenadas, por lo que es posible realizar 
el cálculo de las velocidades de los eslabones mediante el análisis de las velocidades 
de los sistemas de coordenadas respectivos. 


Se supone que se asigna al ¡¿-ésimo eslabón el sistema de referencia {i}. Como el 
eslabón se encuentra en movimiento, en cualquier instante posee una velocidad lineal 
v; y una velocidad angular w;. La velocidad lineal y angular del eslabón i + 1 corres- 
ponde a la velocidad lineal y angular del ¿-ésimo eslabón, sumadas con la velocidad 
propia del eslabón ¿+1 debida a la articulación ¿+1. Como las articulaciones del robot 
pueden ser rotacionales o prismáticas, la nueva componente de velocidad agregada al 
eslabón į + 1 dependerá del tipo de articulación que le proporcione movimiento. 
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Supóngase que la articulación ¿+1 es rotacional. En éste caso, sean los eslabones i 
e i+1, a los que se les asignan los sistemas de referencia {i} e {i+ 1}, respectivamente. 
De acuerdo a lo analizado, la velocidad angular w! +1 Corresponde a la velocidad an- 
gular del eslabón i + 1, expresada con respecto al sistema de referencia {i}. Como se 
considera que el eje de acción de las articulaciones es el eje z, la velocidad angular 
proporcionada por la articulación ¿+ 1 es 0;, es que, transformada al sistema de 


referencia {i}, se convierte en R! A E Por lo tanto, dada la velocidad angular 
wi del eslabón i, se obtiene: 
: 5 2 us 
wii = Wi + RigrdiaZiz1 (4.35) 
donde, para cualquier sistema de referencia, se tiene que gti = [0,0, y”. La ecuación 
(4.35) puede expresarse con respecto al sistema de referencia {i+ 1) si se premultiplica 
por Ri*?, es decir: 
i+ l itl iĝ i+l 
wip = Ri wi Oi (4.36) 
Para obtener una expresión similar a (4.36) correspondiente a la velocidad lineal, 
puede emplearse el análisis de velocidad lineal total. Se sabe que la expresión general 
para la velocidad lineal es: 


vå =ô + Rv? +wÉ x 1? 

Para aplicar ésta ecuación a los eslabones del robot nótese que, al asignar un 
sistema de referencia en algún punto del eslabón, puede enfocarse el análisis en la 
velocidad lineal del origen de dicho sistema de referencia. En éste caso, el vector 
vë = 0, y la velocidad del origen del sistema de referencia {i + 1} consistirá en la 
suma de la velocidad lineal del origen del sistema de referencia {i}, mas la velocidad 
lineal inducida debido a wł. Lo anterior puede expresarse de la siguiente manera: 

t 


i 
x i+1 


el i 
r Vi XT 


donde v!,, es la velocidad del origen del sistema de referencia {i + 1) expresada en 
el sistema {i}, wi la velocidad angular de {i} expresada en {i} y ri, , el vector de 
posición del origen de {i + 1) expresado en {i}. Al igual que en el caso de la velocidad 
angular, al premultiplicar la expresión anterior por pr se obtiene: 


vii = REA RÍA [ui xr] (4.37) 


Empleando las ecuaciones (4.36) y (4.37), pueden calcularse las velocidades lineales y 
angulares en cualquier parte del robot manipulador cuando la articulación considerada 
es rotacional. 


En el caso de articulaciones prismáticas, la velocidad angular del origen del sistema 
de referencia {i+ 1} es igual a la velocidad angular del origen del sistema de referencia 
{i}, debido a que no hay otra articulación rotacional que agregue una componente 
adicional. Por lo tanto, w;,, =w;, y expresado en {i+ 1}: 


it = Rity} (4.38) 
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Para la velocidad lineal, ahora la articulación prismática si contribuye con la com- 
ponente drisi a la velocidad lineal del origen del sistema de referencia {i+1}, junto 
con la velocidad lineal del eslabón ¿, y la velocidad lineal inducida por el movimiento 
rotacional. Por lo tanto, la velocidad lineal se expresa como: 


viti = RP RA [wi x rip] + de zi (4.39) 


donde el término diprzitl representa la velocidad lineal generada por la articulación 
prismática į + 1. 

La aplicación de las ecuaciones (4.36)-(4.39) de manera sucesiva, de eslabón a 
eslabón, permite obtener los vectores w y vi, que corresponden a las velocidades 
angular y lineal del último eslabón, respectivamente. Las velocidades resultantes se 
expresan en términos del sistema de referencia {n}, y la aplicación de dichos resul- 
tados para el cálculo del Jacobiano del manipulador se estudiará más adelante. Ésta 
metodología para obtener las velocidades de los eslabones del robot de modo recursivo 
se denomina Método de Propagación de Velocidades. 


En resumen, las fórmulas para el cálculo de la velocidad lineal y angular del origen 
de un sistema de referencia empleando el método de propagación de velocidades para 
el caso de articulaciones rotacionales y prismáticas son: 


Método de Propagación de Velocidades 


Articulación 
Rotacional v 


Articulación ( i+ ; Wi 
v 


ii pitii AU n 441 
i1 = Ri Vit R; [wi x ri,,] + di412;41 


(4.40) 


Prismática 


La forma de aplicar las fórmulas anteriores es sencilla. Si se tiene un robot de n GDL 
al cual se le asignan n + 1 sistemas de referencia, incluyendo el sistema (0) en su base, 
se deben de aplicar las ecuaciones (4.40) desde į = 0 hasta i = n — 1. De esta manera 
se obtendrán los valores de las velocidades lineal y angular desde v’, w? hasta v”, w”. 
Además, puede agregarse también un sistema de referencia adicional en el efector final 
del manipulador, para así obtener los valores de velocidad correspondientes al efector 
final. 


A continuación se presentan dos ejemplos mostrando la aplicación del método de 
propagación de velocidades. 
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Ejemplo 4.4 


Para mostrar la aplicación de las fórmulas (4.40), se emplea el robot manipulador pla- 
nar de 2 GDL mostrado en la figura 4.6, el cual posee dos articulaciones rotacionales. 
Se desean calcular los vectores de velocidad lineal y angular v3,w%3, expresados en 
{3}, así como los vectores v9, w9, expresados en (0), donde el sistema de referencia 
{0} se asigna a la base del robot, la cual es inmóvil. 


Figura 4.6 Robot manipulador de dos eslabones. 


Solución 


Del análisis de cinemática directa estudiado anteriormente, es fácil determinar los 
parámetros DH de dicho manipulador como se indica en la tabla 4.1. 


Tabla 4.1 Parámetros DH para el manipulador de 2 GDL. 


ĉi —$1 0 0 Ca — 82 0 L 1 L10 0 Lo 

o sic 0.0 1 |s2 & 0 0 O a e a E) 
cd 0 1.0 » Ta 0 0 1 0 » Ta 001 0 
0 0 O 1 0 0 0 i 00.01 
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Debido a que las articulaciones del manipulador son rotacionales, se emplearán las 
siguientes ecuaciones para el cálculo de las velocidades lineal y angular: 


itl _ pilin. „itl 
Wit = R; Wi + DisrZ;y1 

itl _ pitlẹi 0 
vi = Ri vi+R; [w; x ri] 


Dado que la base del manipulador considerado es fija, es claro que w8 = 0 y v8 = 0. De 
esta manera, para comenzar el análisis por el método de propagación de velocidades 


se inicia con į = 0, y empleando las fórmulas para wit] y viti se obtiene: 


. P . 
7 Rlw? + 012) = [R9] w + ız! 


wi = 
a -=a 0]° fo] fo 0 
= $1 C1 0 0 +01 0 = 0 
0 0 a 0 1 Å, 


R} vo + R} [w8 x r] = [R9]" v8 + [R9]" [w8 x r9] 


SS TL a SIA 


Lo @ 1] Lol Lo o 1] Ilo] Lol] 


Lo) 


Ahora se repite el proceso empleando iż = 1: 


1 
y 


ll 
e 

oo 
al 


wi = Riw! + 06322 
Co —$8$2 0 s 0 R 0 
= $2 Ca 0 0 + O, 
0 0-1 Åi 1 
FE 
= 0 
ló+ó,] 
va = Rivi+Riloj xro] 
C2 —$8 0 j 0 Co —S2 0 7 0 Lı 
= S (a 0 0Oi+js2 ca 0 0 x 0 
0 0 1 0 0 0 1 0; 0 
L820 
== Lic&ĝ 
0 
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Dado que en éste ejemplo se agregó el sistema de referencia (3) en el efector final, se 
emplea i = 2 para obtener el último conjunto de velocidades lineal y angular. Nótese 
que, debido a que en el efector final del manipulador no hay ninguna articulación 
adicional, no puede existir otra contribución a la velocidad angular, por lo cual resulta 
evidente que w3 = wi . Por otro lado, para la velocidad lineal se tiene: 


v3 = Rłv3+ R} [w3 x r3] 
100 Lisz, 1 00 0 La 
= 0.10 Lica [+ | 0 1 0 0 x| 0 
0.0 1 0 0 0 1 01 + 0, 0 
L¡s20, 0 Lo 
= Lic20, «+ : 0 s x 0 
0 01 +05 0 
Lis20, 
= Lo [ó, + A + Liezi 
0 


En éste caso, el cálculo de vł no varía si se emplea la fórmula de articulaciones 
rotacionales o prismáticas, ya que no hay otra articulación que agregue componentes 
a v3. Finalmente, las velocidades lineal y angular expresadas con respecto al sistema 
de referencia (3) son: 


Lis201 0 
v3 — La g + A + L¡c20, ,w3 = g 0 4 
0 01 +05 


Para determinar dichas velocidades con respecto al sistema de referencia {0} se hace 
la transformación correspondiente empleando la matriz de rotación RÌ obtenida de la 


cinemática directa del manipulador: 


c2 -si2 0 
R$ = R? R} R? = 812 C12 0 
0 0 1 


por lo que: 
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C12 —$12 0 ] L¡so0, 
g = s2 Cc 0 Lo [01 + 02] + Lic20ı 
0 0 1 | 0 
— L812 g + A - Lı [c2812 _ $2C12] 0, —Lo812 g + A - Lisıĝ 
= Lac12 [ón + A + Li [cac12 + 82812) Å = Lzc12 |n + A + Liciĝı 
0 0 
Ci 312 0 0 0 
wi = Rw? = $12 C12 0 N 0 , = s 0 ] 
0 0 1 01 + 0, 01 +05 


Los valores anteriores permiten determinar en cualquier instante las velocidades lineal 
y angular en el efector final del robot. Más adelante se verá cómo extraer información 
del Jacobiano empleando las expresiones de velocidad lineal y angular. 


Ejemplo 4.5 


Aplicar el método de propagación de velocidades para determinar la velocidad angular 
y lineal del manipulador mostrado en la figura 4.7 para el sistema de referencia (3). 
Además, expresar los mismos resultados en el sistema de referencia (0). 


Figura 4.7 Manipulador de 3-GDL. 


En el análisis realizado en la Unidad de Cinemática Directa, se obtuvieron los paráme- 
tros DH mostrados en la tabla 4.2. 
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Tabla 4.2 Parámetros DH para robot de 3-GDL. 


| ¿ || ais || ais || d: || 0 | 
ippo io io fé | 


|2 [9 f2 fo fé | 
{3io ff % JO ff 6s | 


Empleando los valores DH del manipulador, se obtienen las siguientes matrices de 
transformación homogénea: 


O 
po 
| 
¿e 
po 
a) 
dl 
~ 
N 


C1 | 0 0 


$1 ĉi 0 0 | 


3 
as 
9) 
PX, 
Fami 
© 
a 
© 


m=] 


fam) 
= 
ur 
= © 
t 


CiC9 ~ C182 81 Lic; | 


812 8182 —Ci Lis 


| cıC23 —CiS3 si  Lici+Locica | 
E A 
A S2 Ca 0 0 | mam 


S123 —SiS23 —C1 Liısı + L281C2 
| 823 C23 0 L282 | 


0 0 0 1 0 0 0 1 


Ahora se cuenta con toda la información necesaria para aplicar el método de propa- 
gación de velocidades. Para ello, comenzando con i = 0, se obtiene: 


0 
wi = Rijwy + 1z} = 0 
0, 
0 
vi =Riv8 + R} [u8 x 18] = | 0 
0 
Se prosigue con ¿= 1: 
w = Rlul+ az? 
Ca 0 S2 0 . 0 sab, 
= —$2 0 Ca 0 + 0, 0 — c20 
0 -1 0 0, 1 ĝa 
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ví = Rivi¡+Ri[wj x ra] 
Ca 0 Sa 0 Li 
n —$9 0 Ca 0 x 0 
0 =i Ó Ó, 0 
Ca 0 Sa 0 —0; 0 Lı 
= -82 0 c Å, 0 0 0 
0 -1 0 0 0 0 0 
| & 0 s2 | [ 0 | 0 
= -s 0 & Lið ¡ = 0 
| 0 =i 0 ] | 0 | | Lib, | 


Nótese que en el cálculo anterior se hizo uso de la matriz antisimétrica para obtener 


el producto cruz, es decir, se empleó S(wł)r} = wł x r}. Finalmente, para i = 2: 


wi = R3w? + 0yz3 
C3 s3 0 s201 0 
= =s3 Ca O c201 ar 0 
0 0 1 Å> 03 
Â [s2¢3 + C283] ] | 0 ] 01823 ] 


w al A 


ví = Riv¿+Ri [uz x r3] 
¿[sn ssj 2 [, [sa e 0][[es7 [a] 
la Jl] Lo) 
ca s 0 0 02 cı Lo 
= E +| -83 C3 J | 0, 0  —s201 0 
-L 10, 0 0 1 —cC201 s201 0 0 
E C3 83 j | 0 
= 0 + =S3 &3 0 Loz 
-Lıĝı 0 0 1 —L201co 
0 Lob2s3 | L20283 
= 0 + Lobac3 = : Lo02c3 
=h —Lo0,c2 —0; [Ly + Laca] 
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Para expresar las velocidades anteriores en el sistema de referencia (0) se utiliza la 
matriz de rotación R$, con lo que se obtiene: 


C1C23  —C1S23 $1 Lobas3 
v? = Riv3 = 81CC23 —S1893 C1 , L20303 
$23 C23 0 —01 (Lı + Laca) 
| L20201 [s3C23 — C3823] — 0 [Lisi + L2s1c2] 
= | L02381 [s3c23 — C3823) + 0 [Lici + Lac1C2] | 
L202535823 + L20203023 
-La02c182 - Å [Lisi + Las1c2] 
= —Lob25152 +ô, [L,c, + Lac1c2] 
L26253523 + L2b2c3023 
-Lobac1 52 = Ó, [Lisi + Lo251C2] 
= —Lo2075182 + 01 [Lici + L2c1C2] 
La202c2 
ws 5 R3w3 
C123 —¢C1823 $1 01823 0251 + 0351 
= $1C23 —81823 —C1 Orca | = | —02c1 — O3c, 
523 C23 0 0, + 03 0; 


a 


En la siguiente sección se desarrollará el análisis para determinar el Jacobiano del 
manipulador y se llegará a una expresión que permite entender la estructura del 
robot con base en las ecuaciones obtenidas para el cálculo del Jacobiano. De esta 
manera, cuando se analice la estructura del Jacobiano se tendrá una idea del tipo de 
manipulador con que se está trabajando y, en contraparte, cuando se vea un cierto 
robot se tendrá una idea de la forma que debe de tener su Jacobiano. 


Supóngase que se tiene una expresión de la forma y = F (x), donde y € IR”, x € 
IR”. Empleando herramientas de cálculo vectorial y la regla de la cadena, es sencillo 
verificar que: 


he js J(x)x 


Ox 
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donde la matriz OF (x) /Ox € R”*™ se denomina Jacobiano. 


De modo análogo a la expresión anterior, en el método de propagación de velocidades, 
es posible darse cuenta que las velocidades articulares se pueden relacionar con la 
velocidad lineal y angular empleando una matriz J(q) que depende de las variables 
articulares. Por ejemplo, para la velocidad lineal vê se cumple la siguiente relación: 


v' =J‘ (a)å (4.41) 


donde q = [q1, dn]? es el vector de variables de las articulaciones del manipulador 
y v' es el vector de velocidades lineales. 


Es posible combinar la información obtenida con el método de propagación de 
velocidades a fin de obtener el Jacobiano del manipulador directamente a partir de 
la información proporcionada por vê y wř. El procedimiento consiste en hacer una 
factorización como se indica a continuación: 


v |a| AO |a 
En la expresión (4.42), los elementos J y J$, representan la parte del Jacobiano 
del manipulador correspondientes a la velocidad lineal y angular, respectivamente, 


expresados en el sistema de referencia {i}, por lo que el Jacobiano del manipulador 
puede escribirse como: 


J(q) = l a (4.43) 


A continuación se analizarán los ejemplos realizados con el método de propagación 
de velocidades y, a partir de la información obtenida en dichos casos, se procederá a 
obtener el Jacobiano de cada uno de dichos manipuladores. 


Ejemplo 4.6 


En el ejemplo 4.4 se obtuvieron los siguientes resultados: 


| Lis20, | 0 
vi E Lo [ó, + A + Lıc20ı „w3 = A 0 , 
| 0 01 +02 
—Lo2s12 ô; + A = L1s101 0 
v3 z Lac12 [ó, + A + Escib: wS n R 0 : 
0 0; + 0, 
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Las expresiones anteriores pueden factorizarse como se indica a continuación: 
| Lisz o ] ó [9.0]rg 
v3 = Lica + La Lo | E | wos — 0 0 l Ñ | 
L o ojla” [11j!® 
| Lis T L812 — L25812 ] ”) | 0 0 ] Å 
v3=¡ Lici+Loci  Lacr l i | ws=|0 0 l 2 | 
| 0 0 3 La 1] 


por lo tanto, para éste manipulador, sus Jacobianos correspondientes a la parte lineal 
y angular expresados en los sistemas de referencia {0} y {3} son: 


—Lis1 p Las12 —Lo812 0 0 
J? =| Liıcı+Llc2 Lati |, J2 =] 0 0 
0 0 1 E ! 

Liso 0 0 0 

J = Licz + L2 Lo de = 0 0 

0 0 1 1 


y sus Jacobianos totales, expresados en los sistemas de referencia {0} y {3}, son: 


= Lisi el L3812 = L25812 Lis2 0 
Lici + Loc12 Loac12 Lica+ L2 Lo 
Je 0 0 a Js 0 0 
ww — v e ~- SN y m 
»-| 3 ]- 0 0 pr 0 0 
0 0 0 0 
1 1 | | 1 1] 
Ejemplo 4.7 
En el ejemplo 4.5 se obtuvieron los siguientes resultados: 
l Å $93 La0253 ] 
w3 = 0ic23 v= - Labzc3 
L 0, + 03 | | 0, [Lı + Lac2] ] 
0251 + 0351 = L202¢182 = Å, [Lisi ug L251C2] 
w3 = 0201 — 0301 ,V3= | —Lo025182 + 01 [Lici + Lac1c2] 


0; L20ac2 
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por lo que siguiendo los mismos pasos que en el ejemplo anterior se obtiene: 


0 L383 0 0, $33 0 0 ô 

vi = 0 Lacz 0 02 ¿05 = C23 0 0 0, 

- [Ly =P L2c>] 0 0 03 0 r E | Å» 
—- [Lisi F Losıc2] = Lociıs2 O Ó, 0 s $1 Â 
v? = Lıcı + Lo2cica —Losis9 O 0 „w? =| 0 -c -c 0, 
0 Lac» 0 Å; 1 0 0 Ês 


Finalmente, el Jacobiano del manipulador representado en los sistemas de referencia 


{0} y {3} es: 


=. [Lisi + Lo25102] — L2¢182 0 ] | 0 Los3 0 ] 
Lici + LociCa — L28182 0 0 Lac3 0 
J= 0 Laca 0 J - [Lı + Lc] 0 0 
0 $1 si |” $23 0 0 
=C] a | C23 0 0 
1 0 0 0 1 1 


El resultado anterior se obtuvo mediante la técnica de propagación de velocidades. 
Nótese que el Jacobiano J, puede obtenerse al derivar el vector de posición del efector 
final con respecto al tiempo. Sin embargo, no se cuenta con un vector de orientación 
cuya derivada sea w. Debido a esto, se mostrará más adelante una forma para obtener 
el Jacobiano total J por un método directo. 


4.7.1 Cambio de sistema de referencia del Jacobiano 


El Jacobiano de un manipulador se puede expresar en el sistema de referencia que 
se desee y, dependiendo de la aplicación, será conveniente expresarlo en uno u otro 
sistema de coordenadas. De esta manera, es importante obtener un método por medio 
del cual, dado el Jacobiano J* expresado en un cierto sistema de referencia {i}, lo 
transforme al sistema deseado. Con dicho objetivo en mente, dado el sistema de re- 
ferencia {B}, nótese que: 


v laaa 
[ze 


Ww 
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Supóngase que se desea expresar al Jacobiano JP en el sistema de referencia (A). 
Para ello, nótese que el vector de velocidades lineales v* y el vector de velocidades 
angulares w^ pueden expresarse de la siguiente forma: 


pal- ep] Lo] 


por lo tanto: 


A A 
HAS 


de donde se concluye que para el cambio de sistema de referencia del Jacobiano se 
debe de emplear la siguiente ecuación: 


A 
JA (q) = l Pg A | J? (a) (4.44) 


que transforma el jacobiano del manipulador del sistema de referencia {B} al sistema 
de referencia {A}. 


En el ejemplo 4.6 se obtuvo: 


—Lis¡ =m L812 —Lo512 Lisa 0 
Lici + Lac; LaC12 Lica+L3 La 
J 0 0 z J? 0 0 
D_ v s -- A v n 
Pa|} |- 0 0 Pull 0 0 
0 0 0 0 
1 1 1 1 
y se sabe que: 

ci2 —-si2 0 

RS = $12 C12 0 

0 0 1 


por lo que, empleando la fórmula (4.44), se obtiene: 
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R3 0 
J? = l 3 | J 3 
0 R 
cis —-s12 0 0 0 0 Liso 0 
$12 C12 0 0 0 0 Lico+ Lo Lo 
E 0 0 1.0 0 0 0 0 
Sr 0 0 0 Cig —$812 0 0 0 
0 0 0 $12 C12 0 0 0 
| 0 0 0 0 0 1 ] | 1 1 ] 
| —Lis1 — Losi2 —L2as12 
Lici + Lac12 Lac12 
E 0 0 
E 0 0 
0 
1 1 
lo cual concuerda con el resultado esperado. 
Ejemplo 4.9 
En el ejemplo 4.7 se obtuvieron los siguientes Jacobianos: 
— [Lisi + Lo51C2] —Lo3C189 0 ] | 0 Los3 0 ] 
Lic; + Lac1Ca — L28182 0 0 Loc3 0 
Jia 0 Loco 0 B= — [Li a Lac») 0 0 
0 $1 $1 i $23 0 0 
0 =C] —C1 C23 0 0 
1 0 0 0 1 1 
donde: 
C1C233 —C1S23 Sı 
RÌ = $123 —$1823 —C] 
$23 C23 0 
por lo que: 
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o _ R3 0 3 
r- [F m] 
| exczs —C1823 $1 0 0 0 i) 0 L283 o] 
81023 —S1823 —C1 0 0 0 0 Lac3 0 
e 823 C23 0 0 0 0 | -[L1+ L202) 0 0 
o 0 0 0 CiC93  — —C1823 $1 | 823 0 0 
0 0 0 S123 —S1iS93 —C1 C23 0 0 
| 0 0 0 $23 C23 0 ] | 0 1 | 
| — [Z181 + Lasrcz] =Loc182 0 ] 
Lici + Locco — L25182 0 
a 0 Lac» 0 
0 $1 Sı 
0 —C =c] 
1 0 0 


que nuevamente es consistente con los resultados obtenidos anteriormente. 


4.7.2 Singularidades del manipulador 


Una pregunta interesante que normalmente se plantea en aplicaciones de robótica 
es acerca de la invertibilidad del Jacobiano. Si J es una matriz cuadrada no singu- 
lar, entonces puede invertirse dicha matriz para determinar las tasas de cambio de 
las posiciones de las articulaciones por medio de las velocidades en el efector final 
empleando la siguiente relación: 


à= J (a) | yA | (4.45) 


La expresión (4.45) es importante debido a que, si se desea que el robot se mueva 
con una cierta velocidad en el espacio, se pueden determinar las velocidades de las 
articulaciones necesarias en cada instante a lo largo de la trayectoria de modo que se 
tenga la velocidad deseada. 


Por otro lado, es importante saber dónde no existe la inversa del Jacobiano 
(suponiendo que es una matriz cuadrada), es decir, para qué valores de q la ma- 
triz J se vuelve singular. En el caso de que el Jacobiano no sea una matriz cuadrada, 
en lugar de buscar los valores de q para los que la matriz es singular, se buscan los 
valores de q para los cuales la matriz pierde rango. 
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La importancia de las configuraciones singulares se debe a que, cuando el robot 
manipulador se encuentra en una configuración correspondiente a una singularidad, 
pierde uno o más grados de libertad, es decir, existen direcciones en las cuales no podrá 
moverse. Un ejemplo de singularidad es cuando el robot se encuentra justo en el límite 
de la frontera del espacio de trabajo, ya que sin importar lo que se haga, el mismo 
no podrá extenderse más allá de dichos límites; éstas se denominan singularidades 
en la frontera del espacio de trabajo. Sin embargo, existe la posibilidad de que el 
manipulador posea posiciones singulares dentro de su espacio de trabajo, debido a 
la alineación de los ejes de acción de las articulaciones. En éste caso se dice que son 
singularidades en el interior del espacio de trabajo. 


Ejemplo 4.10 


En el ejemplo 4.6 se obtuvo: 


L¡s2 0 
Lica+ Lo La 

3 0 0 
o 0 0 
0 0 

1 1 


Debido a que el robot se mueve en el plano, es posible considerar la parte de movimien- 
to lineal en el plano, por lo que se emplea la siguiente parte del Jacobiano: 


J? E Lisz 0 
i Licz + Lo Lo 


El determinante de la matriz anterior es: 


det gs = Li L282 


Los valores que hacen que el determinante anterior sea cero corresponden a las con- 
figuraciones singulares del manipulador, por lo que el robot se encuentra en una 
configuración singular cuando 0, = +nr, para n = 0,1,2,... 


Las configuraciones que el manipulador toma en éstos casos corresponden a estar 
completamente contraído (0, = 7), o bien completamente extendido (02 = 0), las 
cuales son singularidades en la frontera del espacio de trabajo. Además, en el mismo 
ejemplo se obtuvo el Jacobiano expresado con respecto al sistema de referencia base: 
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—Lisi — Losi2 —Lo2s12 
Lic; + L>3C1 LoC12 


0_ 0 0 
y. 0 0 
0 0 

1 1 


de donde se extrae la siguiente parte: 


P- =Lısı — Losi —L2812 
i Lic1 + Lac12 Lac12 
entonces: 
det JS = —Lo3C12 [Lis + Las12) + L3819 [Lici + Lzc12] 
= LiLlzcisı2 — LiL2s1c12 
= Lı Laso 


que es el mismo resultado obtenido anteriormente empleando J. Este resultado no 
es sorprendente debido a que: 


0_ p073 
J? = RYJ? 
por lo que: 
det J? = det [R3J3] = [det R$] det Ji = det J 
es decir, no importa el sistema de referencia con respecto al cual se exprese el Jaco- 


biano del manipulador, ya que cualquiera de dichas representaciones proporciona la 
misma información referente a la singularidad del mecanismo. 


El problema de emplear la fórmula: 


TROM 


en un sistema de control de robots es que, en los puntos singulares, la inversa del 
Jacobiano es indeterminada, lo cual implica que las velocidades de las articulaciones 
tienden a infinito cuando se aproxima a la singularidad, por lo cual se pierde el control 
sobre el sistema en dichas configuraciones. 
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En el ejemplo anterior, la inversa del Jacobiano ËE (q)] Y es: 


A ha las Sheall 
J? D a l 151 2812 2812 | 
Y, (a) Lic1 + L2c&i2  L2ci2 
= a l —L2C12 —L2512 | 
LiL2s2 | Lici + Lociz Laisi + Las12 


por lo que el vector de velocidades articulares q se expresa como: 


: <a 
å = [ia] v 
e E | —L2c12 —Las12 | yO 
LiLas2 | Lici + Laciz Lisi + Los12 


En la expresión anterior se observa que cuando q2 = 02 = 0 (o 02 = 1807), el valor de 
q tiende a infinito, lo cual indica el problema que se tendría si el robot se aproxima 
a una configuración singular. 


Ejemplo 4.11 


Para un robot manipulador, el problema no sólo es la singularidad, sino la región 
alrededor de dicha singularidad. Cuando el robot se aproxima a dicha singularidad, 
la representación matemática que relaciona las velocidades, es decir, el Jacobiano, se 
vuelve mal condicionado y, si se trata de hacer un desplazamiento en la dirección en 
la que se pierde movilidad, cuando el robot se aproxima a dicha región se requerirá 
de mucha fuerza para hacer que éste se mueva en dicha dirección. Para visualizar esto 
considérese el manipulador mostrado en la figura 4.8. 


Figura 4.8 Robot de 2-GDL con movimientos alrededor de la singularidad. 
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Los datos cinemáticos del robot son: 


Tabla 4.3 Tabla de parámetros DH para el manipulador planar de dos eslabones. 


| 0 
o ian ca 0.0 y _ j] s52 C2 0 Lys; 
ii 0 AS 0 1.0 | 
0 


| 12 —s1i2 0 Lici + Loaci2 
TO = | sı2 Ci 0 Lisı + L2s12 | 


po 
| 


0 0 1 0 
0 0 0 1 


Para este manipulador es posible obtener el Jacobiano correspondiente al movimiento 
lineal del sistema de referencia {3} expresado en el sistema de referencia {0} como se 
indica a continuación: 


—Lis; == L35819 —Lo812 
J? =| Licı+ Lzc2  Lacr 
0 0 


Éste Jacobiano puede expresarse con respecto al sistema de referencia {1} obtenién- 
dose la siguiente expresión: 


T 
ca -si 0 —Lisi — Los12 —Los12 =L2s2 — —Los2 
Jsl 4 0 Lıcı + Locig L2cr2 = | Li+L2c2 Laca 
0 0 1 0 0 0 0 


Defínanse los siguientes vectores en el sistema de referencia {1}: 


Az! Aq? A0! 
de 1 a | _ 1 
as =| As ].0 [54 |= [âd | 
entonces: 


Debido a que el movimiento del manipulador se realiza en un plano, se emplean 
únicamente las dos primeras filas del Jacobiano lineal J}, expresando esto como J} 3: 
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cuya inversa está dada por: 


c2 1 
21 
BT | Ei | 
Lasa Li 
Es claro que la inversa [Jl a no existe en 93 = 0, por lo que se linealizará ésta 
expresión alrededor de 9, = 0 para observar su comportamiento. Entonces, se emplea 
la aproximación de primer orden sọ = 0 y cg = 1 para obtener: 


Aq} K M 
Aq' = l 1 | x er, A [ax 5 y) 
Aq) hl: LI; -P + 
Ahora se analizará cuál es el desplazamiento requerido en las articulaciones para hacer 


un pequeño desplazamiento en el efector final, es decir, se analizan las siguientes 
relaciones: 


1 
A Mr Ap! —Any! 
E a 
La + Lı 1 
A ¡A SS 1 
12 PAPA a 


Las expresiones anteriores son una aproximación de lo que se obtiene cuando se tra- 
baja alrededor de la configuración 0 = 0. Cuando 0, se vuelve pequeño, se observa 
que se tenderá a hacer una división entre cero, por lo que para obtener cualquier 
desplazamiento pequeño Ax! debe tener un valor muy grande de Aq!. De manera 
gráfica se observa en la figura 4.9 el comportamiento que tendrán Aqı y Aq2 cuando 
0 tiende a cero. 


EN S o 
A A 
-5 -5 
-196 0 1 “M6 0 10 
b 0, 


Figura 4.9 Comportamiento de Aq’ cuando 0 —> 0. 
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Lo anterior significa que no sólo debe suponerse que el único problema es la singula- 
ridad en sí, sino también la región alrededor de dicha singularidad. 


Ejemplo 4.12 


Considérese el manipulador mostrado en la figura 4.10, junto con su tabla de paráme- 
tros DH. Determinar las singularidades del mismo. 


Tabla 4.4 Parámetros DH 
para robot planar de 3-GDL. 


Figura 4.10 Robot manipulador planar de 3-GDL. 


Solución 


Las matrices de transformación homogénea del manipulador son: 


0 C12 —$812 0 Lc; 


0 
To = s  C " ol c2 0 Hi 


0 0 0 1 0 0 0 1 


ES =s123 0 Lici + Loci2 
T? = sı23 C23 0 Lasi + L812 
3 
0 
1 


Lici + L2c12 + L3c123 
Lisı + L25812 + L38123 | 


A |] 


9 

o 

| 

Y 

Y 
=oo0o 29. 


0 
0 0 0 1 


A partir de los datos obtenidos anteriormente, es posible obtener la siguiente expresión 
del Jacobiano en el sistema de referencia (4) expresado con respecto al sistema de 
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referencia (0): 


—Lis1 — La2s12 — L3s123 —L2812 — L38123 —L3s123 
Lici + L2c12 + L3c123 Lac12 + L3c123 L3c123 


2 [ 3 | 0 0 0 
SS JO i 


0 0 0 
0 0 0 
| 1 1 1 


Nótese que cuando 0, = 02 = 0 y 03 = x, el robot se encuentra contraído en su tercer 
eslabón. En dicho caso, el Jacobiano J? pierde rango, lo cual implica que se encuentra 
en una configuración singular. Lo mismo sucede cuando 0; = 0, 02 = x y 03 = 0, 
que equivale a que los dos últimos eslabones se encuentren alineados y, en conjunto, 
completamente contraídos. En dicho caso el Jacobiano pierde rango nuevamente. Un 
tercer caso se obtiene al hacer 0, = 0, = 03 = 0, es decir, cuando el brazo está 
completamente extendido. En éste caso, nuevamente el Jacobiano pierde rango y, por 
lo tanto, el robot se encuentra en una configuración singular. 


Ejemplo 4.13 


Considérese el robot manipulador mostrado en la figura 4.11, junto con sus parámetros 
DH indicados en la tabla 4.5. Determinar las singularidades del manipulador. 


Tabla 4.5 Parámetros DH 
para robot de 6-GDL. 


Figura 4.11 Robot manipulador con 6-GDL. [6 [ 90% | o Ho [0 | 


Las matrices de transformación homogénea que describen la cinemática directa del 
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manipulador son: 


$1 


| ĉi —$1 


C1 
0 
0 


0 
0 
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o | CiCa —C1829 —sSi —L2si 


O =- osos 
o 


=si Cis2 —Los] + cid3s2 
C1 


siS2 Lac, + d3s182 
Ca codz 
0 1 


— 8184 + C1C2C4 —C481 — C1C2984 C182 —Los + Cid3ss 


—C4892 $284 Ca c2d3 


ma1 
ma 
m3 
0 
kii 
ka1 


0 


0 0 1 


—C1C582 + 818485 — C1C9C485 —C481 — C1C984 = L381 + Ci d389 
—C58182 — C18485 — C2C48185 C1Ca4 — C28184 La0c1 + d38182 


Jo | C154 4 CoC4S1 C1C4 — C9S18Sg4 $182 Lc; + d481S9 
4 = 


—C2C5 + C48285 S2584 cdz 
0 0 1 


C182C5 — 818485 + C1C2C4855 —Los] + c1S2d3 
S8182C5 + C18485 + S1C2C485 Lac] + s1s2d3 
C2C5 — 82C485 c2d3 
0 1 


C1C2C4C5 — S184C5 — C18285 

C184C5 — 818285 + $,C9C4C5 

—(985 — S204C5 

C1C2C4C5C6 — 01028486 — (1828506 — 8184C5C6 — 810486 


01828586 — C1C284C6 — $1C4C6 + $184C5586 — C1C2C4C58S6 


C1C486 + C184C5C6 — $1C28486 — 818285C6 + $1C2C4C5C6 
C1C4C6 — $1C284C6 — 01840586 + 518285586 — $1C2C4C586 
S828486 — Ca85Cg — 82C4C5C6 


C68284 + C28586 + C4C5 S286 


Más adelante se mostrará, empleando un procedimiento más simple que el de 
propagación de velocidades, que el Jacobiano de éste robot manipulador calculado 
para el origen del sistema de referencia {6}, con respecto al sistema de referencia (0), 


Alfaomega 


Cinemática y Dinámica de Robots Manipuladores e Roger Miranda Colorado 


4.7 Jacobiano del manipulador 


es: 


— (Lac, + s182d3) 
-= Ls: a cı S2d3 


0 


0 
1 
t46 


tse = 


tes = 


c1Cad3 C152 0 0 0 
$1Cadz $182 0 0 0 
—sSoad3 Ca 0 0 0 
$1 0 cis2 —C481 — CiCosa t46 
ĉi 0 8182 C1C4 — C28184 t56 

0 0 Ca S284 tes | 


C182C5 — 818435 + C1C2C485 
$182C5 + 018485 + $]C02C485 


C2C5 — S29C485 


Nótese que cuando 05 = 0 el Jacobiano se reduce a: 


— (Lac, + s1sad3) 
— L281 + C1S2d3 


Cc1Codz C182 0 0 0 ] 
$iCadz $182 0 0 0 
—soad3 Ca 0 0 0 
—$1 0 (189 —C481 — C1C9S4 C182 
C1 0 S182  C1C4—Co98184 $182 
0 0 Ca S254 Ca | 
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donde se observa que la cuarta y sexta columna son iguales, lo cual significa que la 
matriz pierde rango y se tiene una singularidad. En este caso, la singularidad se debe 
a que, en esta configuración, los ejes 4 y 6 se vuelven colineales, es decir, se pierde un 
grado de libertad. 


Cuando se tiene una articulación rotacional, la variable de la articulación se representa 
por 0;. Para una articulación prismática la variable de la articulación es d;. De modo 
general, las variables de las articulaciones se pueden representar empleando la variable 
qi, sin importar que la articulación sea rotacional o prismática. Para ello se considera 
la siguiente definición de q;: 


1 „ si la articulación es prismática 


ds nr as 
a a { 0 „sila articulación es rotacional 


donde £; representa el complemento de £;, es decir, £¿ = 1 — £;. 


De esta manera, para un robot de n-GDL, todas las variables de sus articulaciones 
se pueden englobar en el vector de coordenadas articulares q € IR”. 


Sea la matriz de Transformación homogénea siguiente: 


i=1_ | Ti T2 Tag Xp 
Ti o | 0 0 0 1 | (an 
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donde r; € R, i = {1,2,3} y xp € IR?. Un aspecto de interés es que el vector Xp 
representa la posición del origen del sistema de referencia {i} con respecto al sistema 
de referencia {i — 1). Por lo tanto, la derivada con respecto al tiempo de dicho vector 
corresponde a la velocidad lineal del origen {i}, la cual puede factorizarse para obtener 
Jy. Por lo tanto, para un robot de n GDL, si se desea calcular J?, basta con calcular 
la derivada del vector xù, obtenido de TÎ, ya que: 


d 
os O. 70 
Va” Jå 


donde v? es la velocidad del origen del sistema de referencia {n}, con respecto al 
sistema de referencia (0). A continuación se muestran un par de ejemplos que ilustran 
ésto. 


Ejemplo 4.14 


Considérese el manipulador mostrado en la figura 4.12. 


Figura 4.12 Manipulador planar de 2-GDL, 


Considerando el sistema de referencia de la base como (0), nótese que la posición 
del efector final, descrita por x,y, puede obtenerse fácilmente como se indica a conti- 
nuación: 


Lici + Lac12 
Lisı + Los12 


= 
| 


~ 


por lo que el Jacobiano J?, relacionado con el movimiento traslacional, se obtiene de 
la siguiente manera: 


Jia) = A es -= E | Eror t Laas al [Lisi + L2s12) —Las12 
Yy dt Yy dt Lis; + L3819 Lic; + L3C19 L>c1> 
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Ejemplo 4.15. 


Se el robot manipulador mostrado en la figura 4.13. 


Figura 4.13 Cálculo del Jacobiano para robot de 6-GDL. 


En desarrollos anteriores se determinó que la matriz de transformación homogénea 
que relaciona los sistemas de referencia (6) y {0} es: 


ki ki2 (18205 — 818485 + C1CaC485 —Los] + C1Ss2d3 


T? = k21 k22 518205 + €18485 + SiC2C4s5 L2cı + s182d3 
A i 
k31 k32 C2C5 — 82C485 cada 
0 0 0 1 


por lo que el vector X5 que representa la posición del origen de {6} desde el origen 
de {0}, es: 
= Lası + C¡Sadz 
Xp = | L261 + si82d3 
c2d3 


Al derivar x> con respecto al tiempo se obtiene: 


—L3c, — Sı8$2d3 Cicadg cıs2 0 
—Lası + c1S2d3 Sıcəd3 sis2 0 
| 0 —sodz Ca 0 


ee 
vo 
Il 


el cı cdz Ci s2 0.000 
T $ Cody $182 0.000 å 
0 am sodz Ca 0.0.0 
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De esta manera, el Jacobiano J? relacionado con el movimiento traslacional es: 


=y Cicadz c&ıs2 0 0 0 
J? =| x sicodz sis2 0 0 0 
0 —sSoadg Ca 0 0 0 


En general, el procedimiento que se ha seguido hasta el momento para el cálculo 
del Jacobiano es complejo. En los ejemplos de propagación de velocidades se deben 
realizar una gran cantidad de cálculos para obtener los vectores v%,w%, luego se 
deben factorizar cuidadosamente para obtener finalmente J%(q). Debido a esto, en 
esta Sección se obtendrá una fórmula sencilla para calcular el Jacobiano de un robot 


manipulador, empleando los datos proporcionados por el análisis cinemático directo. 


Lo que se desea es obtener una representación del Jacobiano con la siguiente 
estructura: 


(:]-uos-[]a 


En el análisis siguiente se analizará el movimiento de los eslabones debido a las arti- 
culaciones. Además. se considerará la contribución de las articulaciones en la velocidad 
lineal y angular, empleando los conocimientos adquiridos en la Sección de cálculo de 
velocidad lineal y angular total, así como de propagación de velocidades. 

Sea el robot manipulador de n GDL mostrado en la figura 4.14, donde se supone 
que la ¿-ésima articulación es rotacional y la j-ésima articulación es prismática. Por 
convención, los ejes de acción de las articulaciones rotacional y prismática son Z; y 
Zj, respectivamente. Por lo tanto, es claro que: 


Wi = diZi 


Vj 952; 
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Figura 4.14 Contribución de las articulaciones de un robot a la velocidad lineal y angular del efector 
final. 


Ahora se buscará una expresión para calcular la velocidad lineal y angular del último 
eslabón del robot, por medio de la suma de las contribuciones en velocidad debidas a 
cada articulación. Éste análisis empleará los conocimientos del Teorema de Euler. 


En la figura 4.14 se muestra el vector Pin, el cual representa la posición del origen 
del sistema de referencia {n}, desde el origen del sistema de referencia {i}. Entonces, 
la articulación rotacional ¿ contribuye con w; a la velocidad angular de {n} y, por 
el teorema de Euler, contribuye con wi X Pin a la velocidad lineal de {n}. Por otro 
lado, la articulación prismática j contribuye con vj a la velocidad lineal de {n}, pero 
no contribuye en nada para su velocidad angular. En la tabla 4.6 se muestran las 
contribuciones a la velocidad lineal y angular de {n}, debido a las articulaciones i y 
$. 


Tabla 4.6 Contribución de las articulaciones a la velocidad lineal y angular del 
efector final. 


| Efector Final || Articulación prismática || Articulación Rotacional | 


| Voia mea Y > IT ap] 
[ Velocidad angular | © č | 7 | 


Tomando como referencia la tabla 4.6, para un robot de n GDL, la velocidad lineal 
total v del sistema de referencia {n} se obtiene sumando la contribución de cada una 
de las n articulaciones, lo cual se obtiene empleando la siguiente ecuación: 

n 
v= y [eivi + Ži [wi x Pin]] 


i=l 
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mientras que la velocidad angular total de {n} se calcula de la siguiente manera: 


n 
w = ) Ejwi 


i=l 
donde e; = 1 si la articulación es prismática y €; = 0 si la articulación es rotacional, 
mientras que €; representa el complemento de e;, es decir, €; = 1 si e; = 0. 


Como el eje de acción de la ¿-ésima articulación es z;, entonces v; = Zii y Wi = 
Zii, donde q; es la magnitud de la velocidad correspondiente a la ¿-ésima articulación. 
Con estas relaciones se pueden reescribir los vectores de velocidad lineal y angular del 
sistema de referencia {n} de la siguiente manera: 


n 
y s k [EiZiqi + Es [Ziġi X Pin]] 


i=1 
w = Y ēiziġi 
i=l 


En la expresión anterior pueden factorizarse los términos q; como se indica a 
continuación: 


v = L [e2; + i [z; x Pin]] di 
w = y EALA 


Al expandir el lado derecho de las expresiones anteriores se obtiene lo siguiente: 
h 

v = [£121 + [21 X Pin] +- EnZn+€n [Zn X Pnn] ] | : | = Jġ 
În 


ES 


Y = [ zı LS aati : pe 
n 
por lo que se obtiene la siguiente expresión para el cálculo del Jacobiano: 


J = Jy _ E1Z1 + El [zı x Pin] wee Eia + En (En x Pnn] 
Ns E1Z1 id EnZn 


La expresión anterior se puede simplificar de la siguiente manera. Sea xp = 
[x,y,z]" el vector de posición del origen del sistema de referencia {n} con respec- 
to a la base del robot. Entonces, la velocidad lineal del sistema de referencia (n) 
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puede calcularse derivando con respecto al tiempo al vector x, como se indica a 
continuación: 


Relacionando los resultados anteriores, se concluye que el Jacobiano Jy para un robot 
de n GDL se obtiene a partir de la siguiente fórmula: 


¿[HO ]_| 32 o 32 
au Jala) o | Exts Eat ii 


Nótese que, al emplear la ecuación (4.47) para calcular el Jacobiano del manipulador, 
sólo se necesitan los datos del análisis cinemático, ya que para calcular J(q) sólo es 
necesario conocer la información de los vectores z;, así como la derivada del vector de 
posición Xp. 

Un aspecto importante de la estructura de (4.47) es que, si se observa la parte 
correspondiente a las velocidades angulares, es posible tener una idea del tipo de 
articulaciones que posee el manipulador, y de la secuencia de las mismas. Por ejemplo, 
si se tiene un Jacobiano en el cual los últimos tres elementos de la ¿-ésima columna son 
cero, y los últimos tres elementos de la j-ésima columna son diferentes de cero, puede 
concluirse que la ¿-ésima articulación es prismática y que la j-ésima articulación es 
rotacional. 

Finalmente, si se quiere expresar el Jacobiano obtenido en el sistema de referencia 
{0}, deben usarse las siguientes expresiones: 


0 0„i 
z; = R;Z; 


y el Jacobiano del manipulador expresado con respecto al sistema de referencia 
{0} se calcula de la siguiente manera: 


Ox, Ox) Ox, Ox, 
JU(g)=| m I |=| Y 0 Y, (4.48) 
¿¡Riz En R? z ēız? Enzo 


A continuación se muestran un conjunto de ejemplos que permiten visualizar la ma- 
nera en que se aplica la fórmula (4.48) para obtener el Jacobiano de un robot ma- 
nipulador. En adelante, cuando se use la ecuación (4.48), se dirá que es el método 
directo para el cálculo del Jacobiano. 
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Ejemplo 4.16 


Sea el robot manipulador mostrado en la figura 4.15. Las matrices de transformación 
homogénea del robot son las siguientes: 


Figura 4.15 Robot manipulador de 3-GDL. 


| Ct —$1 0 0 | Ca — 82 0 Lı C3 83 0 Lo 
mo _ $1 C1 0 0 bea 82 Ca 0 0 - EN $3 C3 0 0 
q 0. 0 1.0 e 0 0 1 0 e 0 0 1.0 
0 0 O 1 0 0 0 1 0 0 oO 1 
ci —sı2 0 Lici cı23 —si23 O Liıcı + Loci2 
T? =| 52 cia O Lis, T? = | $123 4123 0 Lisı + Los12 
2o 0 0 1 0 E 0 0 1 0 
0 0 0 1 0 0 0 1 


Empleando T}, se obtiene el vector de posición x$ del origen del sistema de refe- 
rencia (3), con respecto al sistema de referencia {0}: 


Lic1 + Loc12 


x° = Lis; + Loa812 
0 | 
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Derivando X parcialmente con respecto a q = [q1. q2, gal se obtiene: 


əx? Lis, — Lısı2 əx? -L25812 9x0 0 
e Lc, + Lac12 ri LaC12 a 
qı 0 q2 0 043 0 


De la tercera columna de las matrices de transformación homogénea se obtienen 
los vectores z? como se muestra a continuación: 


0 0 0 
z’ =| 0 |,z3 0 |,z2 =] 0 
1 1 1 


Empleando los datos anteriores, junto con la ecuación (4.48), se obtiene el Jaco- 
biano del manipulador expresado con respecto al sistema de referencia (0): 


| =Lısı — Lisiz —Losj2 0 ] 
Lic1 + Lac12 Lac12 0 
yo — 0 0 0 
me 0 0 0 
0 0 0 
1 1 1 


Ejemplo 4.17 


Sea el robot manipulador mostrado en la figura 4.16. Las matrices de transformación 
homogénea del robot son las siguientes: 
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Figura 4.16 Robot manipulador espacial de 3-GDL. 


0 0 0 1 0 O Q 1 | 
Cilg =CS2 si Lic; CiCg3 —CiSg S1  Lici+Lacicz 
mo | $102 —8182 —C1 Lis T? = | $123 —81823 —C1 Lis1 + La2s1c2 
2 S2 Ca 0 0 ` S23 C23 0 L352 
0 0 0 1 0 0 0 1 


El vector de posición = del origen del sistema de referencia {3}, expresado en el 
sistema de referencia {0}, se obtiene de TÌ: 


Lic, + Loc1Co 


Xp = Lis; + Los1Co 
Los» 
La derivada parcial del vector de posición Xx, con respecto a q = [q1. 42, qa)" es: 
Ox? | —Lis1 — Los1cz 3x? —Loc182 əx? | 0 
— = L¡c1 + Loc,ca 5 = — L28182 y — = 0 
04; | 0 04» | Tts | 043 | 0 
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y los vectores z? son: 
0 $1 $1 
0 0 0 
Z3=|(0/,22=| -c |,23=| -c 
1 0 0 


De esta manera, empleando (4.48), se obtiene el Jacobiano del manipulador ex- 


presado en el sistema de referencia {0}: 


—Lis; an Lo8s1c2 
Lici + LoC1c2 


J? 


= Ooo 


Ejemplo 4.18 


—Loc182 0 
—Lo8189 0 
Laca 0 
$1 $1 
23 -—C1 
o o] 


Considérese nuevamente el manipulador de 


6 GDL mostrado en la figura 4.13. Las 


matrices de transformación homogénea de dicho manipulador son las siguientes: 


| C1 —$1] 0 0 | C1iCl9 —C1iS29 ~S] —Los] ] 
T? = s a 00 T9 = | “2% -8182 Cı Lac; | 
i bh € TAS -s2 -—c 0 0 
0 0 01 0o o0 0 1 | 
| CiCa —si C182 —Los1 + Cid3s> 
T? = C281 Cı  sis2  Loci+d3s182 
a —$2 0 Ca cdz 
0 0 0 1 
—8S184 + C1C29C4 —C4S1 — C1C284 C1s2 —Los] + Cid3s2 
Jo at C184 + C2C481 C1C4 — C2815854 $182 Lac; + d381589 
E —C482 $284 C2 Cadz 
0 0 0 1 
mıı —(10582 + 818485 — C1C2C485 —C481 — C1C284 = L251 + cıd3s2 
T? mao —C58189 — (18485 — C2C48155 C1C4 — C258184 Lac; + d38189 
5 ma —C2C5 + (48285 S254 codz 
0 0 0 1 
ki k12  C182€C5 — 818485 + CiCoCass — L281 + C1Sad3 
T? = k21 k22 $182C5 +C18485 + SiC2Cas5 — Lac1 + 8$182d3 
s k31 k32 C2C5 — 8$2¢C4$5 cadz 
0 0 0 1 
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El vector de posición Xx; del origen del sistema de referencia {6} con respecto al 
sistema de referencia {0} se obtiene de Tf: 


— L281 + C1s2d3 
0 


Xp = Lac, + s18sa2d3 
cadz 


La derivada parcial de X con respecto a q = [q,, sal" es 


əx? —Ləcı — 8182d3 Cicoda cis2 0 0 0 
E = — L281 + 0182d3 sicadg sis92 0 0 0 
a 0 =sadg c& 000 


y los vectores z? se obtienen de las matrices de transformación: 


HP PES 
0 = 23 =| Cc |, =| 3132 | ,2 
E 
| —C48]1 — C1C284 C182C5 — 818485 + C]C2C485 


C1C4 — 028184 ¿Ze = 818205 + 018485 + $1C9C485 
S284 ] | C2C5 — S2C4585 ] 


N 
” 
| 


De esta manera, el Jacobiano del manipulador expresado en el sistema de referencia 
{0} es: 


| - [Loci + s1S2d3] CiCadg (189 0 0 Jie ] 
| — Losı + Cisadg Sıcəd3 $182 0 0 J26 | 
TO: a 0 =s2d3 c2 0 0 J36 
0 -851 O  C1s2 —C481 — C1284 Jag 
0 C1 0 $182 C1C4 — C2815854 J56 
1 0 0 C2 S284 Jee 
Jig = 0 
Jæ = 0 
Jas = C182C5 — 818485 + C1C2C485 
J56 =  $182C5 + C18485 + $1C2C485 
Jee =  C2C5— 820485 
| 
l 
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4.8.1 Jacobiano en el efector final 


En el desarrollo anterior se calculó el Jacobiano hasta el origen del último sistema 
de referencia del manipulador, i.e., hasta el sistema de referencia {n}. Sin embargo, 
no se ha considerado que el robot posea una herramienta que manipule. En dichos 
casos se requiere una transformación adicional para hacer el cálculo del Jacobiano en 
el punto de operación de dicha herramienta. Se denominará a éste como Jacobiano en 
el efector final, J®. 


Se puede emplear una transformación constante que relacione el Jacobiano en el 
efector final, J? , con el Jacobiano J? calculado hasta el n-ésimo eslabón. Lo anterior se 
debe a que, si se asigna un sistema de referencia a la herramienta que utilice el robot, 
el origen del sistema de referencia en el efector final {e} puede referenciarse empleando 
un vector de posición constante Pre desde el origen del sistema de referencia {n}. Lo 
anterior se ilustra en la figura 4.17. 


Figura 4.17 Sistema de referencia {n} y sistema de referencia en el efector final {e}. 


Para obtener el Jacobiano en el efector final se deben calcular las velocidades lineal y 
angular Ve, We en el efector final, suponiendo que se conocen las velocidades lineal y 
angular Vn, Wn en el sistema de referencia {n}. Es sencillo darse cuenta que la relación 
que tienen los sistemas de referencia {n} y {e} es la que se indica en la tabla 4.7, 
donde el vector Pne = [Tne Ynes Zne)” representa la posición del origen del sistema de 
referencia {e} con respecto al sistema de referencia {n}, como se muestra en la figura 
4,17, 
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Tabla 4.7 Relación de las velocidades entre los sistemas de referencia {n} y {e}. 


| Velocidad | Sistema (1) || Sistema (1) | 
Angular a Joo — 
[Enea =p pa] 


El producto cruz Pre X Wn puede expresarse empleando la matriz antisimétrica Pne = 
S(Pne), con lo que se obtiene la expresión Pre XWn = Pnewn. Por lo tanto, la velocidad 
lineal en el efector final puede escribirse de la siguiente manera: 


Ve = Vn + Un X Pne = Vn — Pne X Un = Vn — P newn 


Si se agrupan los vectores de velocidad lineal y angular en el efector final se obtiene 
la siguiente expresión: 


Ve | | Bss —Pne Va | _[ Ix -Êne i 
| We | o | 0 L3x3 | l Wn | j | 0 L3x3 EE 


donde f33 es la matriz identidad en mn. y P,,. se representa de la siguiente manera: 


> 0 —2ne Yne 
e E Zne 0 —Tne 
| —Une Tne 0 ] 


por lo que el Jacobiano en el efector final Je se calcula como: 
L3x3 -Ên | 
da = Jn 
(q) | y Ea (q) 


En la ecuación de Je es importante tener en cuenta cuál es el sistema de referencia que 
se está analizando. Si J? es el Jacobiano expresado en el sistema de referencia (0), 
entonces debe de tenerse la certeza de que el operador P,,. se encuentra expresado en 
el sistema de referencia {0}. De esta manera, el Jacobiano en el efector final, expresado 
en el sistema de referencia cero, es J? , y se obtiene empleando la siguiente fórmula: 


f —p 
q) = l K pr [zow 


En la ecuación anterior se debe prestar atención a la forma en que se cambia el 
sistema de referencia del operador P,,.. No debe de pensarse en cambiar el sistema 
de referencia premultiplicando por la matriz de rotación, ya que P2, 4 ROP*.,. Lo 
anterior se debe a que: 

50 0 0 [pn ,,n 0 [pn o)T 0 

PLu? = RI [Pnu] = AO [Bn [R] 0] 


ne 
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por lo tanto, para cambiar el sistema de referencia del operador producto cruz Pre, 
es necesario emplear una transformación de similaridad. De este modo, si se tiene el 
operador P”?,, su representación en el sistema de referencia {0} es P}, y se calcula 
de la siguiente manera: 

On 077 
mr RF [RS] 


ne 


Ê’ 


ne 


En conclusión, las dos relaciones que permitirán realizar el análisis de un robot mani- 
pulador para transformar el sistema de referencia del Jacobiano o bien para el cálculo 
del Jacobiano en el efector final son: 


; i ( : 
J'(q) m | K je | JP (4.49) 
J 
P a 0 Pn : 0]T P 
J? (q) e | A Ra F [RS] | ds (4.50) 


A continuación se presenta un ejemplo que permite visualizar la forma en que se 
aplican los resultados anteriores. 


Ejemplo 4.19 


Considérese el robot manipulador planar de 3-GDL mostrado en la figura 4.18. 


Figura 4.18 Manipulador planar empleado para calcular el Jacobiano en el efector final. 


Los parámetros DH del manipulador se muestran en la tabla 4.8. 
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Tabla 4.8 Parámetros DH del robot manipulador de 3-GDL. 


E 812 0 | 


0 s > 0 812 C12 0 Lis; 
e A o o ipho o 1 0 
EN $i E RE] 
C123 —Si23 0 Lici + Loc; 
T? = sı23 C123 0 Lis + L28512 
3 0 0 1 0 
0 0 0 1 


La posición del origen del sistema de referencia (3) con respecto a la base del robot 
es: 
x? = Lic; + Loci2 
y3 = Lis1 + Los1 


mientras que la posición del origen del sistema de referencia ubicado en el el efector 
final, referenciado a la base del robot, es: 


eR 

X4 = Lıcı + L2c12 + L3c123 
0 

y4 = L151 + L2s12 + L38123 


Empleando (4.51), el Jacobiano calculado para el origen del sistema de referencia {3} 
es: 

—L1is1 — L28312 —Lo2si 0 ] 

Lici + Lacio Lac15 0 


5 0 0 0 
¿de 0 0 0 
0 0 0 

| 1 1 1 


Si se emplea (4.52) se obtiene el Jacobiano en el efector final como: 


—Lısı — Los12 — L38123 —L2812 — L38123 —L3s123 
Lıcı + Lac12 + L3c123 Lac12 + L3c123 L3c123 


A 0 0 0 
Je = 0 0 0 
0 0 0 
1 1 1 
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Para aplicar la fórmula (4.50) nótese que el vector de posición del efector final con 
respecto al sistema de referencia (3) es p?,. Éste vector y su correspondiente matriz 
antisimétrica se muestran a continuación: 


Es 00 0 
Phre=| 0 [,Ph.=|0 0 -L3 
0 0 Ls 0 


Ahora se cambia la representación del operador P*, para expresarlo en el sistema de 
referencia {0} de la siguiente manera: 


Po, = RE 
Ci23 —sSi23 0 0 0 0 Ci23 —Si23 0 3 
= 5123 Ci3 0 0 0 —L3 s5123  Ci23 0 
0 0 1 | 0 L} 0 | | 0 0 1 ] 
0 0 L38123 
= 0 0 —L30123 
—L38123 L3C123 0 
por lo que el Jacobiano en el efector final es: 
I —R9B3, [Ro]? | o 
J? = 3% ne 143 J 
e 0 Y 3 
1 0 0 0 0 —L358193 —L;,s; -. Lo812 —L3819 0 
0.110 0 0 L3c123 Lici + Loc1> Lac12 0 
pe 0 0 1 L38123 —L30123 0 0 0 0 
E 0.000 1 0 0 0 0 0 
0.00 0 1 0 0 0 0 
000 0 0 1 1 1 1 


—Lis1 — L2s12 — L3s123 —Lo2s1 — L3s123 —L3s123 
Lici + L2c12 + L3cC123 L2c12 + L3c123 L3c123 
0 0 0 


= OS 


0 0 
0 0 
o] 


que es el resultado que se había obtenido anteriormente. 


4.8.2 Aplicaciones adicionales del Jacobiano 


Hasta el momento se ha indicado que los robots consisten en un conjunto de eslabones 
unidos mediante articulaciones, donde la última parte del robot, su efector final, se 
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encuentra libre. Si se desea que el robot se mantenga en una posición específica, pero 
experimenta el contacto con el medio que lo rodea, es posible que algunas fuerzas lo 
afecten en su efector final o que éste tenga que soportar una cierta carga en su efector 
final. En dichos casos lo deseado es mantener el equilibrio estático. 


Si se considera el robot en equilibrio estático, se supone que las articulaciones 
del robot están fijas, por lo que se le visualiza en conjunto como una estructura, y 
puede analizarse al robot eslabón por eslabón. En éste caso, puede establecerse una 
relación de balance fuerza-momento en términos del sistema de referencia del eslabón 
seleccionado. Luego se determinan los pares estáticos que actúan con respecto a los 
ejes de las articulaciones y que permiten que el manipulador se mantenga en equilibrio 
estático. Con este procedimiento es posible determinar los pares requeridos por las 
articulaciones, de modo que el robot sea capaz de soportar una carga estática que 
actúa en el efector final. 


En el análisis siguiente se empleará el robot manipulador mostrado en la figura 
4.19. Anteriormente se empleó el método de propagación de velocidades para calcular 
la velocidad lineal y angular en el efector final. En este caso, se puede realizar un 
análisis iterativo similar, pero comenzando con el efector final en lugar de con la base 
del robot, suponiendo que existe una fuerza f debida al contacto del robot con el 
medio. 


Cuando se ejerce una fuerza sobre el efector final del robot, la estructura del 
mecanismo absorbe parte de dicha fuerza, mientras que el resto es equilibrada por las 
articulaciones debido al par ejercido por los actuadores. Empleando el valor de f, es 
posible obtener, por medio de la eliminación de fuerzas internas, los pares requeridos 
para mantener el equilibrio estático. En dicho caso, es posible analizar los eslabones 
del robot por separado, como se ilustra en la figura figura 4.19. 


eslabón } fa 


Figura 4.19 Separación de los eslabones de un robot debido a su equilibrio estático. 
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Bajo las consideraciones anteriores, la suma de fuerzas es igual a cero y la suma de 
pares es igual a cero. Empleando el sistema de referencia {i}, se obtienen las siguientes 
relaciones: 

fi + [—£i41] = 0 
n; + [ni1] + Piri X [-£i41] = 0 
donde f; es la fuerza ejercida sobre el ¿-ésimo eslabón debido al eslabón į — 1, n; es 
el par ejercido en el ¿-ésimo eslabón debido al eslabón i — 1, y Pi+ı es el vector de 
posición del origen del sistema de referencia {i + 1) desde el origen del sistema de 
referencia {i}. 


Las expresiones anteriores pueden resolverse para f;, n;, obteniendo las relaciones: 
fi = fi+ı 
ni = Diga + Pigi X fi+ı 


Si se emplean las matrices de rotación junto con las ecuaciones anteriores, se 
obtienen las siguientes fórmulas recursivas que permiten determinar las fuerzas y 
pares de eslabones inferiores: 


E Risa (4.53) 
ni = Rinit + pipi 


La ecuación anterior muestra que, si se conocen las fuerzas y pares aplicados en el 
efector final, así como la descripción cinemática de un robot manipulador, entonces 
es posible obtener las fuerzas y pares correspondientes a los eslabones inferiores de 
modo recursivo. 


Nótese que los actuadores del robot deberán ejercer un par capaz de balancear las 
fuerzas y pares de reacción que no sean absorbidos por la estructura del robot, para 
así mantener el equilibrio estático. Dicha fuerza o par es equivalente a la componente 
de los pares o fuerzas de reacción sobre el eje de acción de las articulaciones, por lo que 
se pueden determinar empleando el producto punto, como se indica a continuación: 


gr a i á ; 
[ni] z} , articulación rotacional 
TAES IT i i ; : i 
[£] zi „articulación prismática 


La combinación de las ecuaciones (4.53)-(4.54) permite calcular los pares de las 
articulaciones necesarios para que, al aplicar cualquier fuerza o momento en el efector 
final, el robot se mantenga en equilibrio estático. El método anterior para la deter- 
minación de las fuerzas y pares se denomina Método de Retropropagación de 
Fuerzas y Pares. 


La aplicación de las fórmulas anteriores para el método de retropropagación de 
fuerzas y pares comienza desde i = n, y finaliza en į = 1, suponiendo que el sistema 
de referencia en el efector final es {n + 1}. 
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Ejemplo 4.20 


Considérese el robot manipulador planar de 2-GDL mostrado en la figura 4.20. La 
tabla 4.9 presenta los parámetros DH del manipulador. 


Figura 4.20 Robot manipulador de 2-GDL, 


Tabla 4.9 Tabla de parámetros DH para el manipulador de 2-GDL. 


[+ || ai-ı || ai-ı || d: || 0: | 
{ılo fo fo |a] 
p2 po 1% fo [| 


ci -s: 00 ta — 0 la 100 La | 
o ia a 00 io is o 0.0 w- o L A A 
Ti o o 1012 0 0 1 0 T3 00.1 0 
0 0 0 1 0. 0 0 1 000 1 


Suponiendo que en el efector final del manipulador se aplica una fuerza f? = 
T n : E z 
[fz; fy.0]”, se determinarán los pares que deben de ejercer las articulaciones para que 
el robot se mantenga en equilibrio estático. 
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Debido a que el robot es de n = 2 grados de libertad, se comienza el análisis con 
el valor de ¿ = 2. De este modo se obtiene: 


Íz 


oa BREl f 
0 
n3 = R3n} +p% xf 


0 L fe 0 
PELI IMA 
Lo] Lo] [0] liid 
Ahora se continúa el procedimiento empleando i = 


ple 
ca -=s2 0 fz EA 


fi = Rf =| s2 cc 0 fy | = | S2fz + c2fy 
0 0 1l 0 0 
ny = Ryn} +p xfi 
a -=s2 O 0 Lı C2 fr m S2fy 
=> S2 Ca 0 0 + 0 Xx s2f. + cof, 
0 01 E 0 0 
0 
= 0 


L¡sof, + Licafy T Lzfy 


Finalmente se emplea (4.54) para determinar los pares que se deben de ejercer en 
las articulaciones para mantener el equilibrio estático: 


“S A 
1 


mn = 
| Lis2fz + Licafy + Lofy ] | | 
= Lis2f7 + Licofy + Lofy 
T pi ' E 
mr = [h z3=| 0 0 | =Laf, 
Loaf, 1 


De los resultados anteriores es importante notar que los pares requeridos 71, T2 
pueden factorizarse de la siguiente manera: 


| Ti | B | Lis2 Licz + L2 | l fe | 
T2 äi 0 Lo Íu 


Nótese que la matriz que premultiplica al vector de fuerzas es la traspuesta del 
Jacobiano del manipulador, calculado con respecto al sistema de referencia (3), es 
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decir: 


p= Lıs2 0 

y Lica + La Lo 
por lo que los pares requeridos en las articulaciones para mantener el equilibrio estático 
se pueden expresar de la siguiente manera: 


La expresión anterior indica que existe una relación entre los pares y las fuerzas 
en el robot manipulador, y que dicha relación se establece por medio de la traspuesta 
del Jacobiano del manipulador. 


Supóngase ahora que se aplica en el efector final una fuerza f° = [0, k, o" N, y se 
desean calcular los pares requeridos por las articulaciones para mantener el equilibrio 
estático. En éste caso, como f° se expresa con respecto a {0}, se transforma a (3) de 
la siguiente manera: 


papa ls 
| 0 0 lo 


por lo tanto, los pares requeridos son: 


Ti Liso Lico+L 0 812 
E = = k C12 
T2 0 Lo 0 0 


k l Licı + Lac12 | 
Lac12 


Entonces, el valor de los pares requeridos dependerá de la magnitud de k, y de la 
configuración del robot. Por ejemplo, supóngase que k = —500N, Lı = L2 = 1m, 
0, = 1/2 rad y 0, = Orad. Entonces se obtiene: 


0 
r=| 6| wm 


El resultado anterior no debe ser sorprendente, ya que corresponde a una configu- 
ración del robot en posición vertical. Como la fuerza se aplica verticalmente, toda ella 
es absorbida por la estructura del robot. Por lo tanto, las articulaciones no tienen 
que ejercer ningún par para mantener el equilibrio estático. Además, es interesante 
observar que, en ésta configuración, el robot se encuentra en una singularidad. 


En el ejemplo anterior se mostró que existe una relación entre los pares y las fuerzas, 
la cual se obtiene por medio de la transpuesta del Jacobiano. Un concepto que pueden 
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emplearse para obtener nuevamente ésta relación es el Principio del Trabajo Vir- 
tual. Cuando existen fuerzas que actúan sobre un mecanismo y se produce un des- 
plazamiento, se realiza un trabajo. Dicho trabajo es igual al producto de la fuerza 
por la distancia. La idea básica del principio del trabajo virtual es que las fuerzas que 
producen trabajo son las denominadas fuerzas activas. 


Debido a que el trabajo es un escalar, es posible igualar el cálculo del mismo en 
coordenadas cartesianas y articulares. Suponiendo un desplazamiento infinitesimal y 
el hecho de que el trabajo es un escalar, es posible obtener la siguiente relación: 


£5x =7*5q 


Del análisis previo del Jacobiano se obtuvo la relación dx = Jq, por lo que la ecuación 
anterior puede escribirse de la siguiente forma: 


f£7 Jóq =7*6q 
obteniendo así la relación buscada: 
Tr=JTF (4.55) 


La ecuación (4.55) indica que el Jacobiano transpuesto es un operador que permite 
mapear las fuerzas que actúan en el efector final en pares de las articulaciones. Como 
se ha venido realizando el análisis hasta el momento, si el Jacobiano se expresa con 
respecto a un sistema de referencia {i}, entonces se debe transformar el vector de 
fuerza como se indica a continuación 


r = (197 £? (4.56) 


Un aspecto importante de (4.56) es que permite convertir cantidades cartesianas en 
cantidades en el espacio de las articulaciones sin necesidad de calcular ninguna función 
cinemática inversa. Ésta propiedad puede ser empleada en problemas de control. 


4.9 Control de seguimiento de trayectorias 


Como complemento para los temas analizados hasta el momento, en esta Sección se 
muestra la manera de implementar un control de un robot manipulador empleando 
el análisis cinemático y el Jacobiano. Como se ha analizado, dado un conjunto de 
desplazamientos infinitesimales de las articulaciones ĝq y de las coordenadas opera- 
cionales ĝx, el Jacobiano J (q) permite establecer la relación entre ellos de la siguiente 
manera: 


dx = J(q)0q 
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Dada esta relación, existe un control propuesto por Whitney [10] denominado 
Resolved Motion Rate Control (RMRC) que permite el control del robot manipulador. 


Anteriormente se demostró que existe una relación entre las coordenadas de las 
articulaciones y las coordenadas en el espacio tarea del robot. Empleando la inversa 
del Jacobiano se puede obtener la siguiente relación: 


dq =J7* (q) ôx (4.57) 


Con la ecuación (4.57), si se especifica una trayectoria deseada para el efector 
final, se puede controlar el movimiento del robot para que se mueva de la posición 
actual q a la posición q + ðq, donde dq se obtiene empleando (4.57). El enfoque 
de control mencionado se representa en la figura 4.21. Los pasos de la metodología 
pueden resumirse de la siguiente manera: 


1. El bloque Referencia genera la señal que se desea que siga el efector final del 
robot. Ésta señal se encuentra expresada en el espacio tarea del robot manipu- 
lador, es decir, se describen por medio de las coordenadas (x, y, 2). 


2. El bloque de Cinemática directa calcula los valores de posición actuales x en el 
espacio tarea, empleando los valores de las variables de las articulaciones q. 


3. En el punto de suma se obtiene la resta entre la posición deseada y la posi- 
ción actual del efector final en el espacio tarea. Con esto se genera la señal o 
desplazamiento elemental dx. 


4. En el bloque de Jacobiano inverso J7* se emplea la relación (4.57) para obtener 
el valor deseado dq. Nótese que en este paso se realiza una transformación de 
espacio, ya que los datos de entrada al bloque se encuentran en el espacio tarea, 
mientras que la salida del bloque se encuentra en el espacio articular. 


Los elementos dq obtenidos anteriormente se emplean como señal de error para 
controlar la posición deseada de cada articulación del robot manipulador. Para 
controlar al robot se consideran las articulaciones de modo separado. Por lo 
tanto, para un robot de n-GDL se emplean n controles independientes, lo que 
implica que los acoplamientos que existen entre los eslabones serán considerados 
como perturbaciones, las cuales serán compensadas por el controlador que se 
utilice. 


a 


Para los controles independientes mencionados anteriormente, puede emplearse 
cualquier técnica de control que se desee. En éste caso se emplea una ley de control 
Proporcional Integral Derivativa (PID), la cual posee la siguiente estructura: 


u (t) = kpe (t) + kaë (t) + ki f e(r)dr (4.58) 


donde u (t) es la salida del controlador, kp, ka, ki son constantes positivas correspon- 
dientes a la acción proporcional, derivativa e integral, respectivamente; e(t) = qa(t) — 
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q(t) es el error de posición en el espacio articular, y é(t) la derivada con respecto al 
tiempo de la señal de error. El correcto funcionamiento del control (4.58) depende del 
ajuste de sus ganancias. 


Figura 4.21 Técnica de control Resolved Motion Rate Control. 


Para simular el comportamiento del actuador del robot manipulador se puede emplear 
una función de transferencia correspondiente al modelo lineal de un motor de CD. El 
modelo matemático considerado en éste ejemplo es: 


JÖ (t) + fÊ = 7 = ku (t) (4.59) 


donde J corresponde a la inercia del motor, f el coeficiente de fricción viscosa presente 
en la articulación, 7 es el par de entrada, k la constante del amplificador, u (t) es el 
voltaje del amplificador y 0 (t) la posición del eje del motor. Con el modelo (4.59) se 
puede obtener la función de transferencia del actuador, como se indica a continuación: 


b 


2 TTS 


(4.60) 
donde a = —f/J,b=k/J. Empleando (4.60), se puede modelar cada articulación del 
robot. 


Un punto importante a considerar, antes de aplicar la técnica RMRC, es que debe 
procurarse que la senal dx que entre al bloque del Jacobiano inverso sea pequeña para 
que la relación (4.57) sea válida. Por lo tanto, para asegurar ésto es posible agregar 
un bloque adicional previo al bloque del Jacobiano inverso, en el cual se incluya una 
ganancia de ajuste que asegure que las señales que se ingresan al bloque del Jacobiano 
inverso sean pequeñas. 


Control de robot PUMA 


A continuación se emplea el robot manipulador PUMA, mostrado en la figura 3.23, 
para aplicar la técnica de control RMRC. Los pasos a seguir para aplicar la técnica 
son los siguientes: 
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1. Obtener la cinemática directa del manipulador. 
2. Emplear los datos obtenidos para calcular el Jacobiano del manipulador. 


3. Establecer la metodología de control por cada una de las articulaciones del robot 
aplicando el procedimiento RMRC. 


El análisis cinemático del PUMA se realizó previamente. En este ejemplo se controlará 
el movimiento del punto correspondiente al origen del sistema de referencia ubicado 
en la muñeca del robot. Por lo tanto, la matriz de transformación homogénea que se 
requiere es la siguiente: 


"11 Tia Tis Tia ] 
TO = T21 T22 T23 T24 
Tai T32 T33 T34 
Tar Ta2 T43 Tas 


donde: 
11 =  C48186 + C5C68184 — C1C2C38486 — C1C2C68385 — C1C3C68285 
+C01825838486 + C1C2C3C4C5C6 — C1C4C5C68283 
T12 =  C4C68] — 0581584586 — C1C2C3C684 + 010682583584 + 01025358586 + 0103828556 
—(10903040586 + 010405828386 
Tı3 = —818485 — C1C2C583 — C1C3C582 — C]C2C3C485 + C1C4828385 
T21 =  —C1C486 — C1C5C6S4 — C2C3818486 — C2C68183585 — C3C6818285 + $1825838486 
+C2C3C4C05C681 — C4C5C6 818283 
T22 = —C1C4C6 + C1C58486 — C2C3C68184 + 0681828384 + 0281838586 + C381828586 
(90304058186 + 040581828356 
T23 =  C18485 — C2058183 — C3C58]82 — C9C3C48185 + (451828385 
T31 =  —C2C3C685 + C2838486 + C3828486 + (68258385 — C2C4C5C683 — C3C4C5C682 
T32 =  C2C68384 + C3C68284 + C2C38586 — $2838586 + C2C4C58386 + C3C4C58286 
T33 =  —C203C5 + C58283 + C2C48385 + C3C489285 
a = T14 = 0320103 — L381 — Lac1823 + 0301023 
b = ra = L3cı + 425102 — Las1823 + 0351023 
C = T34 = —Lacaz — 4282 — 43523 


Al considerar el movimiento de la posición del robot, se toma en cuenta la parte del 
Jacobiano correspondiente al movimiento lineal J®, el cual se calcula empleando el 


ns T i 
vector de posición xp = [a,b,c] de la matriz de transformación Tg: 


a2€1C2 — L381 — Lacis23 + 43C1C93 
X, = | L3c1 + a95102 — Las1823 + 4381023 
—Laco3 — 4282 — 03823 
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Empleando el vector anterior, se obtiene el Jacobiano deseado: 


J 1 Jiz Jiz 
J=] Ja Jz Jz 
| Jay ) 32 J 33 | 


donde: 
Ji =  —azsic2— L3cı + Las1823 — 4351023 
Ji = —azcis2 — L4C1C23 — 0301823 
dig = —L4ciC23 — 4301823 
Ja = —L3s¡ + a201C2 — L4c1 823 + 03C1C23 
J22 =  —a28182 — Las1C23 — 4381823 
Ja =  —La4s1C23 — 0381823 
J32 = L4s23 — 0209 — a3C23 
J33 =  Las23 — a3c23 


La trayectoria propuesta para ser seguida por el efector final debe diseñarse de acuerdo 
a las dimensiones del robot ya que, si no se diseña de modo apropiado, es posible que 
se generen puntos que el robot no pueda alcanzar. Para éste ejemplo se emplearon los 
siguientes valores para las dimensiones del robot: 


da = lm 

az = 02m 
L = 03m 
Ly = 05m 


Empleando las dimensiones anteriores, se consideraron dos trayectorias deseadas. La 
primer trayectoria corresponde a un círculo centrado en el origen del sistema de re- 
ferencia {0}. La descripción matemática de ésta trayectoria es: 


z? 1.3 cost ] 
Yo | = 1.3sint 
[2] | os ] 


La segunda trayectoria combina un movimiento sinusoidal con una trayectoria circu- 
lar. La descripción matemática de dicha trayectoria se muestra a continuación: 


xo 1.2cost 
Yo | = 1.2sint 
ad sin (5t) 
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En la figura 4.22 se muestra la gráfica correspondiente a cada una de las trayectorias 
consideradas. 


(b) 


Figura 4.22 Gráficas de las dos trayectorias empleadas para el control de seguimiento con la técnica 
RMRC. (a) Primer trayectoria; (b) segunda trayectoria. 


En la figura 4.23 se muestra el diagrama de bloques general que se empleó para 
implementar el control RMRC. El modelo se diseñó en Matlab-Simulink. 


Figura 4.23 Diagrama de bloques general para el control RMRC. 
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En el diagrama de bloques de la figura 4.23 se aprecian los siguientes elementos: 


1. Subsistema Trayectoria, ROBOT y ROBOT _SW. 


2. Función de Matlab Jacobiano, que contiene el código para el cálculo de la inversa 
del Jacobiano. 


3. Función de Matlab Cinemática Directa, en donde se calcula la cinemática directa 
del manipulador, es decir, se calcula el vector e 


En el subsistema Trayectoria se incluye lo necesario para generar las dos trayec- 
torias deseadas. El subsistema ROBOT contiene los modelos de los actuadores del 
manipulador, es decir, las funciones de transferencia correspondientes a (4.60). Los 
valores empleados para este bloque son los siguientes: 


= 
Gü 250 
s(s +10) 

En el subsistema ROBOT también se incluye la parte de control, que consiste en 
un controlador tipo PID. Finalmente, en el subsistema ROBOT_SW se incluye un 
modelo del robot PUMA creado en SolidWorks. Este modelo permite la visualización 
del movimiento del robot. Éstos subsistemas se muestran en la figura 4.24. 


perras 
i 
Loco rr o e 
Subsistema ROBOT_SW 
pa pil 
a IT a E 


Figura 4.24 Subsistemas Trayectoria, Robot y Robot_SW. 
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La función de Matlab empleada para construir el Jacobiano inverso del manipu- 
lador se implementa con el siguiente código: 


La función de Matlab empleada para determinar la cinemática directa del mani- 
pulador se implementa con el siguiente código: 
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Con los programas anteriores es posible hacer que el robot PUMA siga la trayecto- 
ria deseada, tomando en cuenta que dicha trayectoria se encuentra especificada en el 
espacio tarea del manipulador. Lo anterior es importante debido a que normalmente 
el control del robot se lleva a cabo en el espacio articular, por lo que la trayectoria 
debe de estar especificada en el mismo espacio. Llevar a cabo el cambio de espacio 
anterior implica la resolución del problema de cinemática inversa, el cual consiste en la 
determinación de los valores de las variables de las articulaciones que permiten tener 
una orientación y posición determinadas en el efector final. Sin embargo, empleando 
la técnica RMRC no es necesario resolver éste problema debido a que el proceso de 
cinemática inversa o cambio de espacio se efectúa directamente por medio de (4.57). 
En la figura 4.25 se muestran las gráficas de los errores en el espacio tarea y articular, 
mostrando la efectividad de la técnica RMRC con la primera trayectoria. 
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Error en espacio articular 


t[s] 


Figura 4.25 Errores en el espacio articular y de trabajo para primera trayectoria. 


En la figura 4.26 se muestran las gráficas de los errores de posición correspondientes 
a la segunda trayectoria. 


Error en espacio articular 


3 
tis] 


Figura 4.26 Errores en espacio articular y de trabajo para segunda trayectoria. 


Finalmente, en la figura 4.27 se muestran las gráficas de las trayectorias que siguió 
el manipulador en el espacio tridimensional. Éstas gráficas se pueden comparar con 
las trayectorias deseadas de la figura 4.22. 
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Tirotto T 


pm l 


22 415 


Figura 4.27 Trayectorias seguidas por el manipulador en el espacio tridimensional. 


La conclusión de los resultados obtenidos con la técnica de control RMRC es que se 
trata de un procedimiento sencillo y efectivo para el control de robots manipuladores. 
Además, es una técnica de control de robots en la que no es necesario conocer las 
ecuaciones dinámicas del manipulador. Sin embargo, es importante tener en cuenta 
que muchas técnicas de control moderno son capaces de obtener niveles de desempeño 
muy elevados, pero requieren del uso de las ecuaciones dinámicas. Por lo tanto, el 
análisis que se desarrollará en la siguiente Unidad permitirá dar un primer paso en 
dicha dirección. 


A continuación se presentan un conjunto de ejercicios complementarios que permiten 
visualizar la aplicación de los temas analizados en esta Unidad. Se recomienda tratar 
de resolverlos de modo independiente y verificar las respuestas obtenidas con los 
resultados que aquí se muestran. 


E 


Sea el robot manipulador de la figura 4.28. Considérense los sistemas de referencia fijos 
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en la base {0} y el efector final {e}. Emplear el método de propagación de velocidades 
para obtener: 


Figura 4.28 Uso del método de propagación de velocidades en robot PRR. 


Solución 


Para resolver el problema, primero se debe calcular la cinemática directa del ma- 
nipulador. Para ello se considera la asignación de los sistemas de referencia mostrada 
en la figura 4.29. Empleando la asignación de los sistemas de referencia indicados, se 
obtienen los parámetros DH, como se indica en la tabla 4.10. 


Tabla 4.10 Parámetros DH 
para robot PRR. 


Figura 4.29 Asignación de sistemas de referencia. 
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Ahora se obtienen las matrices de transformación homogénea del manipulador: 


[200 t] [ ez -s2 00] 


o 0 10 0 1 0 0 1 La 
a. 0.0 1 d igm -s2 -Q 0 0 
00 1 


0 0 0 0 1 
E -s3 0 0 tO 0 o ] 
T=] 0 0 -1 -Ls | mj 0 10 0 
` S3 C3 0 0 Ane 0.0.1 Li 
0 0 0 1 0% 1 


mientras que la composición de las matrices de transformación se obtiene de la si- 
guiente forma: 


1 0 0 Lı | Ca —$2 0 0 
010 0 0 0 1 L 
ji- oa 0ml _ 2 
T o s; Ta o 0 0 1 dı ga —C2 0 0 
0.000 1 0 0 0 1 
co -s2 0 Li 
= 0 O 1 Do 
E —% —0 0 dı 
0 0 0 1 
co -s2 0 Li Ca =s3 0 0 
o 02 T 0 0 1 Lù 0 0 -1 -L3 
T5 o 131; E —32 —C 0 dı S3 C3 0 0 
0 0 0 1 0 0 0 1 
| Cata  —C2s3 s2 Lı + L3s2 ] 
e] S3 C3 0 Lo 
E =S2¢3 S2853 C2 dı + L3c2 
| 0 0 0 1 ] 


0203 =cos3 S2 Lai + L3s2 ] | 1 

0 — mom 53 c3 0 Lo 0 
SNE = yae m =s2C3 $2853 C2 dı + L3c2 0 
0 0 0 1 0 


| cac3 —C283 $2 Li+ [L3 + Lo] s2 ] 


O or-o 
O -oo 


= oo 
has o 


0 0 0 1 


Ahora se utilizarán las ecuaciones de propagación de velocidades. La primera articu- 
lación es prismática, por lo que se utilizan las siguientes fórmulas: 


i+l _ pi+l i 
wii = Ri w 
i+1 


A lis a Te 
i1 = Ri vit Ri [wi x ri4) + di 12,1 


0% $3 C3 0 Lo 
| =s2C3 8283 Ca dı + [L3 + Le] c2 | 


W: 
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donde v = 0, wf = 0. Por lo tanto, considerando į = 0 se obtiene: 
1 1,0 
wi = Ryw=0 
H 
vi = Rivo +R} lu xr}] + dz} = | 0 
å | 


La segunda articulación es rotacional, por lo que se emplean las fórmulas: 


ai Feo ai 
wr = R; wi + 0412531 

ii itii IT iai 
Vi = R vi+R; [w; x ria] 


Ahora se considera que ¿ = 1 y se obtiene: 


0 
w = Riul+07323=| 0 
02 
ví = Rivi +R? [ul xr] 
Ca 0 —$2 0 —d182 
= —$92 0 — C? 0 = —d cz 
0. 1.0 dı 0 


Para la tercera articulación rotacional se emplea į = 2 y se obtiene: 


ww = R3w3 + 0323 
C3 0 $83 0 0 0253 
= -s3 0 c 0 |+| 0 |=] 62c3 
0 -1 0 Å 03 Å; 
vá = Rivi+Rilo x r3] 
C3 0 $3 —d182 C3 0 $3 ] 0 
izi | —=83 0 C3 | | 6 | + | —$3 0 C3 [f 0 | Xx | — 
Lo a ojl o J Lo a ojllà] | 
—d1 $2¢3 C3 0 53 0 De 0 0 
= | d18283 | + | -s3 0 c3 | | 0 0 A | -L3 | 
L aea | Lo a oJlo o ojlo] 
—d1 8203 C3 0 s L30, 
= dı 8283 + =s3 0 c 0 
-dı 8203 L30203 -d1 8203 + L3ĝzc3 
= dis2s3 j| + —L30283 | = | dis2s3 — L30253 
dico 0 dicz 
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Finalmente, para el efector final se emplea ¿ = 3. En éste caso, pueden usarse 
de modo indistinto las fórmulas de articulación rotacional o prismática. El resultado 
obtenido es: 


0283 
we = w3 = 0203 
03 
vo = Riv3+R5 [w3 x re] 
=d; 8365 + L30acz 0353 0 
= dıs283 — L30253 + | 0203 Xx 0 
dico 0% Le 
—dıs2¢3 + L3bacz 0 =;  Êzc3 0 
= d18983 = L30283 + 03 0 — 0383 0 
dıc2 — 0903 253 0 Le 
| -d) SaC3 + Labacz | L.02c3 -d, Sa2C3 + Laac3 + Lob2c3 
= dis2s3 — L30283 | + | —Ledos3 | = | dis283 — L30283 — Lo02s3 
| dica | | 0 | L dicz | 


Ahora se utiliza T? para obtener las velocidades con respecto al sistema de refe- 
rencia (0): 


C2C3  —C983 S2 03583 
0 0 ; 
We = Rawi = 83 C3 0 O2€3 
—8S203 $253 C2 03 
0387 
0309 
CaC3 —C983 $2 —d 18903 + L30503 + L.¿02c3 
A ó ; ; À 
v = R= S3 C3 0 dı8283 — L30283 — Lel283 
=82C3 8283 C2 dıc2 


| L302c2 + L¿02c2 ] 


| di - E — Leĝ282 ] 


Se factorizan los resultados anteriores de la siguiente manera: 


-d1 8203 + Labac3 + Leĝzc3 —S2C3 [L3 + Lel C3 0 dı 
ve = | dis2s3— L30283 — Lodosz | = | s2853 —[|L3+Lo]s3 0 02 
d1c2 c2 0 0 03 
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L302c2 -+ L.02c2 0 [L3 + Lel Ca 0 dı 
v= 0 =| 0 0 0 0, 
d, - L30282 — L.0282 p [L3 T Lel s2 0 0%, 

0389 0 0 S2 dı 

w=| 6% |=|0 1 0 Åp 

030 0.0 cz Ås 


— S223 [L3 + Lal C3 0 ] | 0 [Ly + L.) Ca 0 ] 
8983 _ [L3 + Lel sg 0 0 0 0 
"E Ca 0 0 o_|1 -—[L3+Le]s2 0 
E 0 83 o=] o 0 s2 
0 C3 0 0 1 0 
0 0 1 0 0 Ca 


Ejemplo 4.22 


En el ejemplo anterior, aplicar la fórmula de cambio de sistema de referencia del 
Jacobiano para determinar J? a partir de J£. 


Solución 
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El resultado se obtiene directamente al aplicar la fórmula de cambio de sistema 


de referencia: 


0 R? 0 e 
2- [9 p] 
| CaC3 —C(983 82 0 0 0 ] —892C3 [L3 + Lel C3 0 ] 
$3 C3 0 0 0 0 8253 — [Ly + Le] s3 0 
m —S2C3 S2853 C2 0 0 0 Ca 0 0 
E 0 0 0 C2C3 —C983 S2 0 $3 0 
0 0 0 83 C3 0 0 C3 0 
0 0 0 — S203 8283 C2 0 0 1 
0 [Ly + Le) Ca 0 
| 0 0 0 | 
_ |1 -[Ls+Le]s2 0 | 
0 0 $2 
0 1 0 
0 Ca 
Ejemplo 4.23. 


Sea el robot manipulador mostrado en la figura 4.30. Empleando la asignación de 
sistemas de referencia mostrada en la figura y el método directo para el cálculo del 
Jacobiano, determinar J} y J}. 


=A 


a” 


Figura 4.30 Robot manipulador de 5-GDL. 
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Solución 


Empleando la asignación de sistemas de referencia indicada en la figura 4.30, se 
obtienen los parámetros DH del manipulador, como se indica en la tabla 4.11. 


Tabla 4.11 Parámetros DH para robot manipulador de 5-GDL. 


Con los parámetros DH anteriores se calculan las matrices de transformación ho- 
mogénea siguientes: 


pa -s, 0 0 ] E -s 0 0 ] 
Mi $1 C1 0 0 D- $1 C1 0 0 
dal Y 0 Lapo” 0 0 1 L+d 

| 0 0. 0.1 ] 0 0 0 1 
| C1C3 —C183 $1 0 ] | 0103 $1 C153 c1s3da 
T? = S1C3 —~8183 —3 0 T? ES 38103 —(] $183 $1S83d4 

> 83 C3 0 Lı + dz A- $3 0 —C3 L, + d ani Cada 
0 0 0 1 0 0 0 1 
C1C3 Sı  C183 L5c1583 + C1s3da 


83 0 —c3 Li¡+d2- L5cz — Cada 


o_ į $163 —C1 $183 L;5s183 + 8183d4 
| 0. 0.0 1 | 


De las matrices de transformación anteriores es posible obtener los siguientes datos: 


0 0 $1 C183 
s=|0|,3%=|/0]|,23=| =a |,24=| 3183 
1 1 0 —C3 
cisada L5c183 + Cisada 
0 0 
Xp4 = sis3da :Xp5 = L58183 $ sıS$3d4 
Lı + da — Cada Lı + d2 — L5c3 — cada 
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Finalmente, empleando las variables articulares q = [q1, q2; 3. A = (01, d2, 03, ay", 
se obtiene los Jacobianos del manipulador como se indica a continuación: 


—$18304 0 Ci Cada C183 
Ct sala 0 $1 cada $183 


Ox" ax" ax" ax" 
J? =| Y Dos Te Tia = 0 l sida -c3 
z? 0 z? 0 0 0 $1 0 
0 0 —C] 0 
1 0 0 0 
Əxps Ops Ops 
e 2 043 öqa 
[FTES] 
| anir- — L5sı$3 0 cıc3d4 + L5ci1c3 €183 
C18: 30da p L5c; $3 0 siCada + L581C3 $183 
1 sada + L5s3 —C3 
i 0 $1 0 
0 0 — C] 0 
1 0 0 0 
Ejemplo 4.24 


Sea el robot manipulador mostrado en la figura 4.31. Con la asignación de sistemas de 
referencia mostrada en la figura, utilice el método directo para el cálculo del Jacobiano 
para determinar J} y J?. 


Figura 4.31 Robot manipulador de 4-GDL. 
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Solución 


Empleando la asignación de sistemas de referencia de la figura 4.31, se obtienen 
los parámetros DH que se indican en la tabla 4.12. 


Tabla 4.12 Parámetros DH del robot manipulador de 4-GDL. 


Empleando los parámetros DH de la tabla 4.12, se obtienen las matrices de trans- 
formación homogénea del manipulador: 


& -s 0 0 | i 0 0 f ] 
T? a $1 C1 0 0 T4 e 0 1 0 0 
0 0 L Ey [+ 0010 
0 0 0 1 000 1 
ciC3 —CiS2 si  Laci CiC23 —CisS2g3 si  Laci+L3cic2 
T? = | $12 8182 —C1 Las, T? = | $103 —81823 —C1 Las, + L3s1c2 
Sa Ca 0 Lı ds $23 023 0 Lı + L3s2 
0 0 0 1 0 0 0 1 
C1C23C4 — $184 —8S1C4 — C1C2384 —C1S23 Loci + L3cicz + L4c1C23 
TO? = | 8162304 + C184 C1C4 — $1C2384  —S1823 Las, + L3s1c2 + Las1C23 
s 5234 84823 C23 Lı + L3s2 + Lasa 
0 0 0 1 
C1C23C4 — $184 —S1C4 — C1C23854 —Cis23 Tera 
T? S1C23C4 + C184 C1C4 — $1C2384 =81823 Te24 
€ S23C4 84823 c23 Tea 
0 0 0 1 
Tea = Loci + L3cico + Lacicoz — Les184 + Loc1C2304 
Toa = L2s1 + L3s1c2 + Lasic23 + Locisa + Los1023C4 
Tega = Li + L3s2 + Laso + Los2304 


De las matrices anteriores se obtienen los siguientes datos: 


0 $1 $1 —C1823 
o 0 0 0 
Zi = 0 Z2 = a l 23 = (1 12,4 = — 81823 
1 0 0 C23 
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x 
ps 
II 


| 
| 
| 


Xpe = | 


Lac1 + Lzcıc2 + Lacica3 
Lası + L3s102 + Las1C23 
Lı + L3s2 + Las23 | 
Laci + L3cic2 + Lac1to3 — Lo.s184 + L.C1093C4 
Las1 + L3s102 + Las1023 + Loc184 + Lo510293C4 
Li + L3s2 + Laso23 + Les23C4 ] 
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y, empleando las variables de las articulaciones q = lq1, q2, q3; q4)” = [01, 02,03, 04l, 
se obtienen los Jacobianos del manipulador como se indica a continuación: 


4 xa OA 
Ja = 0q1 042 
z? z? 
1 2 


—L2s1 — L3s102 — Las1C23 
Loc + L3c1c2 + Lac1C23 


o 
Opa 
043 


a 


o 0 
0 
0 
| 1 
qe = 091 öda 
zi Z2 
[a Jiz 
Ja J22 
e 0 J32 
o 0 $1 
0 —=(C1 
1 0 
Jn = 
Ja 
Jiz 
J22 
Ja = 


$1 
SA 
0 
o o 
zi z} 


— L4c1823 — LeC1823C4 
— L481823 — L.81823C4 
Lac23 + LeC23C4 
$1 
by 


0 


—L3c1582 — Lacis93 — L.C1823C4 
—L3s1582 — Las1823 — Lo81823C4 
L3ca + Laco3 + L.C23C4 


—L3c1s2 — Lac1823 
—L3s182 — L481823 
L3c2 + Laca3 


—L4c1823 0 
—L481823 0 
LaCo3 0 
$1 —C1823 
=C] — 81823 
0 C23 | 


—Les1C4 — L¿C102384 
L¿c1C4 — L¿51C2354 
—L.582384 
7 C1823 


81323 
C23 


—L2s1 — L3s1c2 — Las1C23 — Locis4 — Lo51023C4 


Laci + LgciCa + LaciCo3 — L.s184 + L¿C1C23C4 


En el ejemplo 4.23, emplee la fórmula del Jacobiano en el efector final para obtener 


J? a partir de J}. 


Solución 
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Para éste manipulador se tienen los siguientes datos: 


0 C1C3 Sı  C183 
4 0 
Ps = 0 , R4 = $103 —C1 2183 
Ls 83 0 3 
por lo que se obtiene: 
C1C3 $1 C183 0 L5C183 
0 0,4 
Ps = R4P5 == SiC3 —C1 $183 0 = L58183 
$3 0 —C3 Ls —L5c3 
y la matriz antisimétrica: 
x 0 Ls5c3 Lssy 83 
S(p?) = Ê} = —L£Ls5c3 0 —L5c183 
—Lss183 Lsc183 0 


por lo tanto, considerando q = [q1, q2, 43, qe = [01,d2,03, da]" y empleando el méto- 
do del Jacobiano en el efector final, se obtiene: 


DO 
R = E D E 
1.0.0 0 —-L5cg3 — L58183 —81S3d4 0 cicg3d4 C183 
D l p L5c3 0 Ls5e; $3 C1 sady 0 s 1 cada $183 
0 y l L58183 —L5c183 0 0 1 sa3da —C3 
0.0.0 1 0 0 0 0 S1 0 
0.0.0 0 1 0 0 0 -c 0 
000 0 0 1 1 0 0 0 


—=8183d4 — L58183 0 citada + L5cic3 C183 
cisada + Ls5scıs3 0 sıca3d4 + L5siC3 5183 


a 0 1 sada + L583 == 05 
o 0 0 $1 0 

0 0 =C] 0 

1 0 0 0 | 


Ejemplo 4.26 


En el ejemplo 4.24, emplee la fórmula del Jacobiano en el efector final para obtener 
J? a partir de JÌ. 
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Solución 


Para este manipulador se tienen los siguientes datos: 


Le C1C23C4 — $184 —8S1C4 — CiCo3z84 —C1893 
4 0 > 
Pne = 0 ¿Ry = S1C23C4 + C184 — C1C4 — $1C2384 781823 
0 | $23C4 —$4823 C23 


por lo que se obtiene: 


C1C23C4 — 8184 —81C4 — C1C2384 —C1823 Lo 

0 0x4 
Pne = RiPne= | $1C23C4 + C184  C1C4 — 8102384  —81823 0 
S23C4 = 84823 C23 0 


Le [e1c2304 — 5154) 
= Le [s1c23C4 + C154] 


L.S23C4 
m | 0 —L.89304 Le [s1 02304 + c184] 
po. = L.S23C4 0 -Le [cr 02304 = $184] 
| -Le [s1C23C4 T c184] Le [c1 02304 > $184] 0 ] 


De esta manera, con q = [q1.92,93,94]. = [0,.02,03,04)”, se emplea el método del 
Jacobiano en el efector final para obtener: 


DO 
J? = I —P?, J? 
s 0 I A 
Jı Jia —Lacis23 — Loc182304 —Les1C4 — LeC1C2384 
Ja J22 —Lasis23 — LesiS2304  LeciCa — Les1C2384 
= 0 Ja Lac23 + Lec2304 —L.52384 
0 $1 $1 —C15823 
0 —<c —C1 — 381323 
1 0 0 C23 
Jı = —L£L2581 — L3zsıc2 — L481C23 — LeC184 — LoS1C23C4 
Joy = Laci + L3c1C2 + L4CiC23 — Los184 + LoC1093C4 
Ji = —L3cıs2 — Lacis23 — LeC1823C4 
J22 = —L3s1s2 — La4s1823 — L¿51823C4 
Jz2 = Lze + Lacoz + L.Co3Ca 


Sea el robot manipulador del ejemplo 4.23. Suponiendo que se aplica en el efector 
final una fuerza f° = (1,0, 11”. Determinar los pares de articulación necesarios para 
que el robot manipulador mantenga el equilibrio estático. 
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Solución 


Empleando el análisis de aplicaciones adicionales del Jacobiano, sea J? la parte 
del Jacobiano en el efector final correspondiente a la velocidad lineal. Para éste ma- 
nipulador se sabe que: 


—sisSada4 — L5sisg3 0 citada + L5cic3 €183 


cıS3d4 + Lses O sSıczd4 + L5S1C3 8,8 
[ acs do Ab 1834 50183 1€304 5813 $183 


0 1 sada + L5s -c 
R? = SiC3 —C1 $183 JE = 0 0 2 Ra 553 a 
1 
l k Y 0 | 0 0 -s 0 
l 0 0 0 
por lo que: 
—sSıS3d4 — Lssisg3 O cıczda + L5ciC3 (183 
q = ci83da + L5c1s3 O sitiada +L5s103 $183 
| 0 1 sada + L5s3 —C3 ] 
Cıĉ3 Si  C183 1 C1C3 — C183 
f° = RE = SiC3 —C1 31383 0 = 813 — 8183 
S3 0 —C3 -1 S3 + C3 


De esta manera, los pares necesarios para que el robot se mantenga en equilibrio 
estático son: 


r= [RA 
| —8183d4 = L58183 0 cıc3d4 + L5c1C3 C183 4 C13 — C183 
= cisada + L5cıs3 0 sic3da + L5si03 8183 81C3 — 8183 
| 0 1 sada + L5s3 —=(3 ] | 83 t C3 ] 
| 0 
. 83 + C3 
da + Ls 
-1 


En este Capítulo se estudió todo lo referente al cálculo del Jacobiano de un ma- 
nipulador. Se mostró cómo se puede calcular e interpretar el Jacobiano para cualquier 
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manipulador. Se deben comprender los conceptos analizados en esta Unidad debido 
a que, cuando se estudien las ecuaciones dinámicas de un manipulador, todas estas 
herramientas se emplearán como partes fundamentales. Por ejemplo, si se utiliza el 
enfoque Euler-Lagrange, se deben calcular expresiones de energía cinética y potencial 
del robot, las cuales se obtienen de una manera relativamente sencilla a partir de los 
datos proporcionados por el Jacobiano del manipulador. Por lo tanto, al compren- 
der los temas aquí analizados se obtiene una herramienta sólida con la que se puede 
contar en análisis futuros de robots manipuladores y permitirá, no solo obtener las 
ecuaciones dinámicas del manipulador, sino también diseñar estrategias de control. 


4.1 Considerando las velocidades lineal y angular, ¿cuál es una posible aplicación que 
se le puede dar al Jacobiano?. 


4.2 Indique qué es un cuerpo rígido. 
4.3 ¿Qué es lo que indica o representa el Teorema de Euler?. 


4.4 Dados dos sistemas de referencia {A} y {B} con diferente origen y orientación, 
si se representa un punto en movimiento en un sistema de referencia y se quiere 
determinar su velocidad lineal, dicha expresión se escribe de modo general como: 


vå =068 + Róv? +wĝ x r^ 


donde of representa el origen del sistema de referencia {B} con respecto al sistema de 
referencia {A}, wii la velocidad angular de {B} con respecto a {A}, vë la velocidad 
lineal del punto p en {B} y r? la posición de p expresada en (A). Indique de modo 
detallado la interpretación de cada uno de los términos que componen a la velocidad 
lineal vå. 

4.5 Explique en qué consiste el método de propagación de velocidades. 


4.6 ¿Qué son las singularidades en un robot manipulador y cómo pueden determinarse 
a partir del Jacobiano?. 


4.7 ¿Cuáles son los tipos de singularidades que puede poseer un robot manipulador 
y cuál es el significado de cada una?. 


4.8 Sea S una matriz antisimétrica. Demostrar por cálculo directo la ecuación: 
S (ax + By) = aS (x) + BS (y) 


4.9 Demostrar por cálculo directo que: 


dRy 0 
di 


pe. Ra, 
= S (j) Ryo, =p = S (k) Rao 
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4.10 Sea el robot manipulador de la figura 4.32. Considérense de modo fijo los sistemas 
de referencia de la base {0} y el sistema de referencia en el efector final (e). Emplear 
el método de propagación de velocidades para obtener: 


Figura 4.32 Robot manipulador PRP. 


4.11 En el ejercicio 4.10, aplicar la fórmula de cambio de sistema de referencia del 
Jacobiano para determinar J? a partir de J£. 


4.12 En el ejercicio 4.10, emplear el Jacobiano para determinar las configuraciones 
singulares del manipulador. 


4.13 Sea el robot manipulador mostrado en la figura 4.33, donde se muestra de modo 
explícito la ubicación de los sistemas de referencia de la base {0} y en el efector final 
{e}. Empleando el método directo del Jacobiano, determinar: 


1. J? 


E Je 
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Figura 4.33 Robot manipulador PRPR. 


4.14 Para el ejercicio 4.10, emplee el método directo de cálculo del Jacobiano para 
calcular: 


1. J} 


2. J? 


4.15 Sea el robot manipulador mostrado en la figura 4.34, donde se muestra de modo 
explícito la ubicación de los sistemas de referencia de la base {0} y en el efector final 
{e}. Empleando el método directo del Jacobiano, determinar: 


1. J? 


EXE 
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Figura 4.34 Robot manipulador RPP. 


4.16 Sea el robot manipulador mostrado en la figura 4.35. Agregando un sistema 
de referencia {e} en el efector final y empleando el método directo del Jacobiano, 
determinar: 


1. J? 


2. J? 


Figura 4.35 Robot cartesiano. 


Alfaomega Cinemática y Dinámica de Robots Manipuladores e Roger Miranda Colorado 


4.12 Ejercicios 221 
4.17 Sea el robot manipulador mostrado en la figura 4.36. Empleando el método del 
Jacobiano básico, determinar: 
0 
l. Ja 


2 JE 


Figura 4.36 Robot manipulador RRRP. 


4.18 En el ejercicio 4.13 emplee la fórmula del Jacobiano en el efector final para 
obtener J? a partir de Jf. 


€ 
4.19 En el ejercicio 4.15 emplee la fórmula del Jacobiano en el efector final para 
obtener J’ a partir de JÌ. 
4.20 En el ejercicio 4.16 emplee la fórmula del Jacobiano en el efector final para 
obtener J’ a partir de JÌ. 
4.21 En el ejercicio 4.17 emplee la fórmula del Jacobiano en el efector final para 
obtener J? a partir de JẸ. 
4.22 Sea el robot manipulador del ejercicio 4.10. Suponiendo que se aplica en el efector 
> > T . . q . 
final una fuerza f° = [1,0,—1]”. Determinar los pares de articulación necesarios para 
que el robot manipulador mantenga el equilibrio estático. 


4.23 Sea el robot manipulador del ejercicio 4.13. Suponiendo que se aplica en el efector 
T 5 A 2 3 

final una fuerza f° = [1,0,—1]”. Determinar los pares de articulación necesarios para 

que el robot manipulador mantenga el equilibrio estático. 
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4.24 Sea el robot manipulador del ejercicio 4.16. Suponiendo que se aplica en el efector 
final una fuerza f° = [1,0,— 1”. Determinar los pares de articulación necesarios para 
que el robot manipulador mantenga el equilibrio estático. 


4.25 Aplicar la técnica RMRC para controlar un robot manipulador no planar de 3 
GDL en seguimiento de trayectorias. 
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A lo largo del espacio hay energía... es una mera cuestión de 
tiempo hasta que los hombres tengan éxito en sus mecanismos 
vinculados al aprovechamiento de esa energía. 


Nikola Tesla 


En el análisis de los robots manipuladores que se ha realizado hasta el momento no 
se ha considerado cuáles son aquellas fuerzas que causan su movimiento. Lo anterior 
importante debido a que un control que requiera exactitud del sistema se logra 
mediante el uso de un conjunto de ecuaciones diferenciales que permiten modelar de 
manera adecuada al robot. Estas ecuaciones reciben el nombre de ecuaciones dinámi- 
cas, y describen el movimiento del manipulador a partir de los pares o fuerzas ejercidos 
por los actuadores o por las fuerzas externas que le son aplicadas. 


Cuando se estudia el control del robot, es importante contar con un conjunto de 
ecuaciones diferenciales que describan su dinámica. Una vez que se conocen dichas 
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ecuaciones, es posible establecer diversas estrategias de control, desde las que emplean 
el modelo linealizado del sistema, como aquellas que consideran su descripción no 
lineal. 


Un aspecto importante es que las ecuaciones que describen al robot pueden es- 
cribirse preservando una cierta estructura que permite distinguir propiedades fun- 
damentales del robot, así como establecer técnicas de control que aprovechen las 
propiedades de ciertas matrices presentes en las ecuaciones dinámicas. 


En el análisis que se desarrollará en esta Unidad, primero se obtendrán las ecua- 
ciones de Newton-Euler, las cuales se aplicarán para determinar las ecuaciones dinámi- 
cas de un robot manipulador. Éstas ecuaciones se obtendrán a partir de un proce- 
dimiento que sigue los pasos del método de propagación de velocidades y retropropa- 
gación de fuerzas y pares. 


Otro enfoque que se empleará en ésta Unidad es el de las ecuaciones de Euler- 
Lagrange. En dicho enfoque se utilizarán las denominadas coordenadas generalizadas 
del sistema a modelar y, usando el Lagrangiano del sistema, se obtendrán las ecua- 
ciones dinámicas del mismo. 


En cualquier caso, como los cuerpos rígidos experimentan movimientos de rotación 
y traslación, al realizar el modelado deben conocerse sus propiedades inerciales, lo cual 
implica tener el conocimiento de la masa e inercia del sistema. En el caso de robots 
manipuladores, éstos poseen múltiples cuerpos rígidos unidos mediante articulaciones. 
Por lo tanto, sus propiedades de masa se describen por medio de las m; masas de 
sus eslabones, mientras que su inercia se describe mediante el denominado tensor de 
inercia, 

A continuación se presentará un análisis detallado que muestra cómo calcular el 
tensor de inercia de un cuerpo con masa uniformemente distribuida. Luego se mostrará 
cómo, a partir de un procedimiento iterativo similar al de propagación de velocidades 
y retropropagación de fuerzas y pares, es posible obtener las ecuaciones dinámicas 
de un robot manipulador, por medio de las ecuaciones de Newton-Euler. Finalmente, 
se mostrará un procedimiento alterno, empleando las ecuaciones de Euler-Lagrange, 
para calcular las ecuaciones dinámicas de diversos sistemas, incluyendo no sólo a 
robots manipuladores, sino también circuitos eléctricos y sistemas subactuados (i.e., 
sistemas con menor número de entradas de control que grados de libertad). Además, 
se mostrará que éste análisis puede extenderse al caso de robots manipuladores con 
flexibilidad en sus articulaciones. 


NADAN de Mmasa 


Cuando se tiene un sistema con un grado de libertad, usualmente se habla acerca de 
la masa de dicho cuerpo rígido cuando se presenta un movimiento lineal, mientras que 
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cuando se tiene un movimiento rotacional se maneja el término de inercia. Un cuerpo 
que se mueve en el espacio puede rotar con respecto a cualquier eje, y las posibilidades 
de seleccionar dicho eje son infinitas. En dicho caso es importante poder caracterizar 
cómo se distribuye la masa de dicho cuerpo. Cuando se estudian éstos aspectos se 
considera el concepto de Tensor de Inercia, el cual permite caracterizar la inercia 
de un cuerpo rígido y puede considerarse como una generalización del momento de 
inercia escalar. El tensor de inercia es de gran importancia debido a que permite el 
cálculo de cantidades fundamentales tales como la energía cinética correspondiente al 
movimiento rotacional. 


A continuación, considérese una masa m; que rota con respecto a un eje ubicado a 
una distancia perpendicular h, como se muestra en la figura 5.1. El tiempo requerido 
para que la masa m; alcance una velocidad angular w es proporcional a su masa y al 
cuadrado de su distancia perpendicular al eje de rotación. Por lo tanto, el producto 
mih? representa una medida de su inercia u oposición al movimiento rotacional. El 
producto m;¡h* se denomina inercia o momento de inercia de la masa mi, con respecto 
al eje de rotación, y se representa mediante 7 [7, 9]. 


Figura 5.1 Masa m, rotando alrededor de un eje ubicado a una distancia perpendicular h. 


El procedimiento para determinar la inercia de un cuerpo rígido se describe a con- 
tinuación. Sea el cuerpo rígido C, compuesto por un conjunto de partículas de masa 
mi. En la figura 5.2 se muestra una de dichas partículas, la cual se encuentra rotando 
con respecto a un eje. También se muestra el vector unitario e = ja, Ba, el cual 
tiene la misma dirección que el eje de rotación. La distancia h; corresponde a la dis- 
tancia perpendicular de la masa al eje de rotación. Además, se muestra un sistema de 
referencia con origen en algún punto a lo largo del eje de rotación. Empleando dicho 
sistema de referencia, se ubica a la masa m; por medio del vector p; = [£i, Yi. zi]? 
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y 


Figura 5.2 Cuerpo sólido rotando con respecto a un eje arbitrario. 


Si se traza una línea perpendicular desde la masa m; al eje de rotación, el punto s; 
corresponde al punto de intersección de ésta línea con el eje de rotación, y el vector que 
ubica dicho punto, con respecto al sistema de referencia mostrado, es s;. Empleando 
la figura 5.2, se observa que la distancia h; puede calcularse de la siguiente manera: 


2 2 
h? = |p|" — (sil 


Además, empleando el producto punto, el vector s; puede expresarse como s; = (p;, €), 
por lo que: 


2 2 
h; = |ip:ll?-— [(p;,e)l 
= 1? +y? +z? - [azi + Byi + yzl? 
a F 
= rity +z- [a?a? + 2ax; [Byi + yzi) + [Byi + 121) ] 
= z? +y? +z? - [208Briyi + 2022: + 28yyizi + a?r? + By? + y?2?] 


= z} - 20y2;2 — 28yyi2; — 20Briy +y; +z; a By 
Como e es unitario, i.e. |je]| = 1, la expresión anterior puede desarrollarse de la 
siguiente manera: 
h? = z? -—2ayzrizi — 2ßyyizi — 20 Br:yi + y? + z? -ar — By A 


e 
t Ti 
2? — 2ayzizi — 28yyizi — 20Briyi +y? +2? — [1 - 8? - 7°] 2? 


- [1 — a? - y2] y? - [1 - a? - B?] 2? 
ay? — 2aryziz; — 28yyizi — 20 Busy + Bat add als pa yy? 
a lyi +2] + 8? [27 +27] + 1? [27 +y] — 2layrizi + Bryizi + aBxiyi] 


Para calcular la inercia Je del cuerpo rígido C, basta con sumar las inercias de todas 
las partículas del cuerpo, es decir: 


l= y mih? (5.1) 


1€C 


Cinemática y Dinámica de Robots Manipuladores e Roger Miranda Colorado Alfaomega 


228 Capítulo 5. Dinámica del manipulador 


Al sustituir la expresión de h? en (5.1) se obtiene la siguiente expresión para el cálculo 
de la inercia Je del cuerpo C: 


le = 5 m;h? 
¡eS 
= D Mi (y? + z2) +8? p% Mi (z? + ze) + DD mi (z? + y?) 
¡eS ies ies 
=a | ay 5y MT ¡Zi + BY F MiYiZi + aß Ý MiTiYi 


iES iES ¡ES 


Los términos de la ecuación anterior tienen nombres específicos, como se indica a 
continuación. 


Momentos de inercia principales y productos de inercia 


Las cantidades: 


Tia ye mi [y? + 2] (5.2) 


¡es 
> Mi En + zai 

¡es 
Los pe mi Es $ y] 


¡ES 


se denominan momentos principales de inercia, mientras que las 
cantidades: 


Se MiTiYi (5.3) 


iES 


y MiTtiži 


iES 


> MiYiZi 


iES 


de denominan productos de inercia. 


Empleando las definiciones anteriores, se reescribe el momento de inercia Je de la 
siguiente manera: 


lo = Laos + li md E 2aßIzy — 207 Lx: — 2ByIyz 
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Dada una matriz A € IR"*” y un vector x € IR”, la expresión x7 Ax recibe el 
nombre de forma cuadrática. Dada la estructura de Ie, se observa que la inercia 
puede reescribirse como la siguiente forma cuadrática: 


l.=| 8 Lux Ly -Ip B | =e'le = (e, le) (5.4) 
Y —Lix —liy Izz | Y | 
donde: 
i gae —Lzy — Izz 
I= j —lyz Iy -Iy 
-Izz —Lzy Izz 
se denomina Tensor de Inercia. 
En las definiciones dadas por (5.3), se observa que Ly. = Izr, Loy = yrs Iys = Izy- 


Por lo tanto, se concluye que el tensor de inercia es una matriz simétrica, es decir, 


Las E. 


Tensor de inercia 
La matriz I dada por: 


Izz —Lzy —Lzz 


Tigo “"izy Izz 


I= | re E | (5.5) 


se denomina tensor de inercia, y los valores de los elementos 
que lo constituyen se calculan empleando (5.2)-(5.3). 


El cálculo del tensor de inercia de un cuerpo rígido puede realizarse con respecto a 
cualquier sistema de referencia. Sin embargo, normalmente se calcula empleando uno 
que se encuentre unido al cuerpo rígido. 


A continuación se mostrará una manera alternativa para calcular los elementos 
del tensor de inercia de un cuerpo rígido. Para ello, considérese nuevamente el cuerpo 
rígido C y una partćula del mismo de masa m;, como se indica en la figura 5.2. 


Para movimientos lineales, a la cantidad m;v; se le denomina momento lineal, 
donde v; es la velocidad lineal de la partícula de masa m;, inducida por el movimiento 
rotacional. En el caso de movimientos rotacionales, el momento angular de la masa 
m; se representa por ġ;, y corresponde al producto p; X m;v;, donde p; es el vector 
de posición de la masa m;. Por lo tanto, el momento angular de C, denotado por Q, 
se calcula sumando los momentos angulares de todas las partículas que lo conforman, 
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es decir: 
pg (pi, mivi] 
¡ec 


Ds [m;p;. [w, p:]] 


iEC 


e 
Il 


donde se empleó el hecho de que v; = w X pi. 


Si V es el volumen de C, el volumen de cada partícula m; es AV. Entonces, al 
considerar que la masa de C se encuentra uniformemente distribuida, se satisface la 
relación m; = pAV, donde p representa la densidad de C. De esta manera, empleando 
la matriz antisimétrica S(p;) para el producto cruz, se obtiene: 


$ = Y [-S(pi)S(p:)pAV] w 


ieC 


Al calcular el límite cuando AV tiende a cero, se obtiene la siguiente fórmula para el 
cálculo de q: 


$ = p [-S(p:)S(p:)] pav | w 


El momento angular corresponde al producto de la inercia por la velocidad angular. 
Por lo tanto, en la expresión anterior, el término correspondiente a la integral es el 
tensor de inercia, es decir: 


1= f [-S(P)S(Pi) pdv 


En el desarrollo siguiente se omitirá el uso del subíndice ¿ para el vector p;. Nótese 
que el término —S(p)S(p) puede expresarse como: 


-S(p)S(p) = [p"p]I3x3 — pp? 


con l3x3 la matriz identidad en IR?**?. Por lo tanto, el tensor de inercia puede calcu- 
larse empleando la siguiente fórmula: 


I= Í [[p* p] L3x3 — pp] pdv (5.6) 


Empleando el tensor de inercia I, el momento angular H de un cuerpo rígido se expresa 
como: 


$ = Iw 


Las componentes del vector p son p = |z, y, a”, por lo que p7p = z? + y? + 2?, 
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mientras que: 


a? y zz 
pp? = | zy y yz 
az yz z? 
y? + 2? -7y —2Z 
—S(p)S(p) = -rty 142 -yz 
—=rz -yz r?+y? 


Empleando las relaciones anteriores, se obtienen las siguientes ecuaciones que per- 
miten calcular los elementos del tensor de inercia como se indica a continuación: 


TIL [y? + 2°] pdv 
IIL (1? + 2°] pdv 
q TTI (2? + y?] pdv 


a” 
R 
Il 


~Œ 
5) 
ù 

Il 


Izy = TTI xypdv 
V 

L m f1 xrzpdv 
V 

ya = iji yzpdv 
V 


Considerando el sistema de referencia {A}, cada punto del cuerpo rígido C se ubica 
empleando un vector p? = [z, y, ar, y el tensor de inercia de C, calculado con respecto 
a (A). se representa por I^. Los elementos de I^ dependen tanto de la posición 
como de la orientación del sistema de referencia, y es posible obtener, usando los ejes 
principales de inercia, productos de inercia iguales a cero. 


La fórmula general para calcular la inercia de un cuerpo se describe por medio de 
la ecuación (5.1). Si el cuerpo se compone de un material homogéneo de densidad p, el 
elemento de masa diferencial dm equivale a pdV, y el momento de inercia del cuerpo 
puede calcularse empleando la integral: 


I= / h?dm = p f h? dV (5.7) 


En general es necesario evaluar una triple integral para determinar el valor de inercia 
del cuerpo. Sin embargo, en el caso de que el cuerpo tenga dos planos de simetría, 
es posible determinar su momento de inercia mediante una única integral eligiendo 
como elemento de masa dm una placa delgada perpendicular a los planos de simetría 
como se indica en la figura 5.3. En éstos casos será necesario emplear la fórmula del 
Teorema de ejes paralelos que se analizará más adelante. 
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X 
b 


cra mad 


Figura 5.3 Placa delgada como elemento de masa diferencial de un cuerpo rígido. 


Un concepto importante en el análisis del tensor de inercia son los ejes principales 
de inercia, los cuales corresponden a los ejes descritos por los vectores propios del 
tensor de inercia. Un cuerpo rígido que gira alrededor de uno de estos ejes no varía su 
orientación en el espacio, debido a que cuando un sólido gira alrededor de uno de sus 
ejes principales el momento angular $ y la velocidad angular w son vectores paralelos. 
Todo cuerpo rígido tiene al menos un sistema de tres ejes de inercia principales, i.e., 
siempre se puede diagonalizar su tensor de inercia. 


Sea 1 el tensor de inercia del cuerpo expresado con respecto a los ejes principales del 
mismo. Entonces, dicho tensor es constante. Si se transforma 1 al sistema de referencia 
de interés, debe de emplearse una transformación de similaridad, por lo que I = RĪRT, 
donde R es la matriz de rotación que relaciona al sistema de referencia deseado con 
el sistema de referencia descrito por los ejes principales de inercia. 


En el caso de movimientos lineales, la derivada del momento lineal corresponde a 
la fuerza. Para movimientos rotacionales, la derivada del momento angular es igual al 
momento N, que se calcula de la siguiente manera [8]: 


d E PR 
N = qdo =t + g [RIR Jw 
= Iv+ [ RIR" + RĪR”] w 
= Iù + S(w)RĪRTw + RĪRTST (w)w 


= Ig +wx iw 


En la expresión anterior, el elemento Iw puede verse como la parte del producto 
de masa y aceleración para un movimiento lineal, mientras que el término restante 
corresponde a las fuerzas centrífugas y de Coriolis. 


A continuación se muestra un ejemplo que permite el cálculo del tensor de inercia 
de un prisma, empleando los resultados anteriores. 
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Determinar el tensor de inercia del prisma mostrado en la figura 5.4, con respecto al 
sistema de referencia mostrado. Se supone que el cuerpo tiene densidad uniforme p. 


3 b 


Xx 


Figura 5.4 Ejemplo de cálculo del tensor de inercia para un prisma. 


Solución 


Primero se obtendrá la inercia del prisma con respecto al eje x. Nótese que para 
cualquier elemento de masa diferencial dm y de volumen diferencial dV elegido, la 
distancia perpendicular al eje de rotación siempre queda establecida por h? = y? + 2?. 
Además, debido a que se considera que la masa del prisma se encuentra uniformemente 
distribuida, se cumple la siguiente relación: 


dm dV 


m vV 


lo cual implica que dm = mdV/V, donde m es la masa del prisma y V su volumen. 


De esta manera se obtiene: 
z yä A [y? + 2°] dedydz 


miy [2+] dz 


" =f [+ az] az= mb [Seta | 
— “Y dea LS ey S Sl; 


mb E + a _ mabe [a? + e?] om [a? + e?] 
vV 3 o 3abe Ml 3 


Izz 


l 
x 
N 
a 
3 
ll 
se 
> 
bo 
py 
|3 
a 
= 
A] 


Il 
<|3 
o 
== 

<= 

[>] 

a 

x 

¿E 

a 

<= 

a 

EN 
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Siguiendo un procedimiento similar al anterior, se obtienen las siguientes expresiones 
para el cálculo de los momentos principales de inercia con respecto a los ejes y e z: 


ly = J h?dm = / h? zav] => =S f p [x? + 2?] drdydz 
V vV 0 0 0 
m (1? + e?] 
3 
la = | i?dm= / r [Fav] = E >f f E TER 
V vV 0 
_ m [a? + b?] 
= HE 


Para el cálculo de los productos de inercia se tiene: 


c a b 
Iz = zS f F xy dxdydz 
o Jo Jo 
m fE [*[a? 1 m 
= — 7 Fe- aii f" Z ydyd: 
2 2,2 
z mb [E P = we y de 
0 


ma? _ mab 
4 mz 41 


y de la misma manera para I+, e Iyz: 


m mb? fe f* 
Izz = mf f, Ji xz dxdydz mf / zdydz 
o o 2V Jo Jo 


mab? mab?c mbe 


2V (a 4V 4 


m 
->f f A yz dxrdydz = 
o Jo 


Empleando los cálculos anteriores, el tensor de inercia del prisma, calculado con res- 
pecto al sistema de referencia {A}, es: 


| 
a 
È 
Il 
| 


mab mbe 
| Loss — Izy -Izz 3 par. f -74 
r = —Izy : —Iyz = A mah mfb zes ] _ mac 
LS == E se [a240] 
Tz yz 22 _ mbe _ mac idad Sa 
4 4 3 


donde el superíndice A indica el sistema de referencia con respecto al cual se está 
calculando el tensor de inercia. 
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Teorema de Steiner o de ejes paralelos 


El valor del tensor de inercia depende de la posición y orientación del sistema de 
referencia considerado. El teorema de Steiner, también denominado Teorema de ejes 
paralelos, permite determinar los cambios del tensor de inercia a partir de modifi- 
caciones debidas a traslaciones del sistema de referencia considerado. Este teorema 
permite relacionar el tensor de inercia de un sistema de referencia cuyo origen se en- 
cuentra en el centro de masa del cuerpo, con el tensor de inercia del mismo calculado 
con respecto a otro sistema de referencia paralelo. 


Teorema de Steiner 


Sea el cuerpo rígido con masa m mostrado en la figura 5.5. Sean la e Ip 
los momentos de inercia del cuerpo con respecto a los ejes a y b, donde 
a pasa por el centro de masa del cuerpo rígido y b es paralelo al eje a. 
Los ejes a y b se encuentran separados una distancia d. Entonces existe 
una relación space los momentos de inercia tal que: 


Io = La + md? 


Figura 5.5 Teorema de Steiner. 


Ahora supóngase que se tiene un sistema de referencia {C} localizado en el centro de 
masa de un cuerpo rígido y sea el sistema de referencia {A} trasladado de manera 
arbitraria, pero paralelo a {C}. Entonces, el teorema de Steiner puede plantearse de 
la siguiente manera para el eje z: 


Ia = Ia +m [re +y] 
A = Ss — ML Ye 
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Los momentos de inercia restantes se obtienen de manera similar intercambiando las 
componentes adecuadas. De este modo, sea på = [£e, Ye, ze)” el vector que ubica el 
centro de masa del cuerpo rígido con respecto al sistema de referencia {A}, paralelo a 
{C}. Desarrollando los términos de inercia restantes se obtiene la siguiente expresión 
para el cálculo del momento de inercia empleando el Teorema de Steiner: 


1 =I +m [PEPcIsx3 = pepe] 


donde 3x3 representa la matriz identidad de 3 x 3. 


l Ejemplo 5.2 | 


Sea un sistema de referencia {B} ubicado en el centro de masa del prisma mostrado 
en la figura 5.4. Determinar el tensor de inercia del cuerpo con respecto al sistema 
de referencia {B} y, suponiendo que {B} es paralelo a {A}, emplear el Teorema de 
Steiner para determinar el tensor de inercia con respecto al sistema de referencia {A}. 


Solución 


Considerando el sistema de referencia {B} ubicado en el centro de masa del prisma, 
el momento de inercia con respecto al eje z está dado por: 


Lg: = a F E (2? + y?) didydz 


€ a 


m f? f? $ P i 
= S [i (F +| , dva 
z 7 3 
o m 3 b o balla 
PLL, llar] [rar]. 


ái zN F [h +n] wag E pre] a 
ee) 


m El + n mabe (a? + b?) om (a? + b?] 
12V di 12 


tu 


eN 


dz = 


y de la misma manera se obtiene: 


m (a? + e?] L = m [b? ES c?] 


Izz = . 
12 sx 12 


Alfaomega Cinemática y Dinámica de Robots Manipuladores e Roger Miranda Colorado 


5.2 Distribución de masa 237 


Debido a la simetría del prisma, los productos de inercia son nulos. Por lo tanto, el 
tensor de inercia buscado con respecto al sistema de referencia (B) es: 


m ate? 
[A o, o 
12 d | 0 m| le 0 | 
mla? +b? 
0 0 | ] 


Ahora se empleará el Teorema de Steiner para obtener el tensor de inercia I^. Para 
ello, sea pj, el vector que ubica el origen de {B} con respecto a {A}, entonces: 


donde: 


T 1 
põ [p] -T 


y) 
e) 


De esta manera, aplicando el Teorema de Steiner para el sistema de referencia {A}, 
se obtiene: 


T T 
14 = 124+ml[p3]' péis — pá [p3]*] 
m a? e 
mla*+e*] 0 0 
a m [b*+c*] 
0 12 e 
0 0 12 
a | ad+bt e 0 0 ] by? ab be 
+ — 0 ad+bt+e 0 — | ab a? ac 
s| 0 0 a+] be ac e? 
[ mfa? +0? mab _mbe ] 
3 4 T 


mac 

E. A 

_ mbe _ mac m [a?+0?] 
i 4 3 


Il 
m 
: 3 

a 

=> 

3 
— 
K 
+ 
A 
w 


que es el mismo resultado obtenido anteriormente con el cálculo del tensor con respecto 
al sistema de referencia {A}, lo cual verifica el uso del Teorema de Steiner. 
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Finalmente, dado un cuerpo rígido, supóngase que se tienen dos sistemas de refe- 
rencia (A) y {C}, los cuales pueden diferir tanto en su posición como en su orientación. 
El siguiente paso consiste en determinar las ecuaciones que transforman un tensor de 
inercia de {C} a {A}. 

Para obtener la transformación deseada, sea IC el tensor de inercia del cuerpo en 
{C} y supóngase que {C} se ubica en el centro de masa del cuerpo. 


Sea el sistema de referencia (C,) con origen coincidente con el origen de {C} y 
con la misma orientación que {A}. Por lo tanto, la matriz de rotación RS relaciona 
los sistemas de referencia (C,) y {C}. Empleando transformaciones de similaridad, 
se obtiene el tensor de inercia con respecto a {C1} de la siguiente manera: 


10 = RGC [rG] 


Como la orientación de {A} es la misma que la de {C1}, entonces Re = Rå, por lo 
tanto : 

1% = RETO [RA]? 
El tensor de inercia anterior se calculó con respecto al sistema de referencia {C1}, 
cuyos ejes son paralelos a los de (A). Por lo tanto, es posible emplear el Teorema de 
Steiner para calcular I^. Para ello sea Pô, el vector que ubica el origen de {C1} con 
respecto a {A}. Entonces: 


T P 
1^ = 1° +m |[på,]" på, isxa — på, [på] ] 
Finalmente, al sustituir el valor de I®™ se obtiene: 
p sy T 
14 = RETO [REJ” +m [[p8,17 pá, Loxa — på, [94,17] (5.9) 


Con la ecuación (5.9) es posible transformar el tensor de inercia calculado en un 
sistema de referencia a otro sistema de referencia, sin importar que los ejes del último 
no sean paralelos al sistema de referencia inicial. 

A continuación se incluyen algunos ejemplos que sirven de apoyo para comprender 
cómo deben calcularse los tensores de inercia de algunos cuerpos rígidos particulares. 
Dichas estructuras pueden encontrarse con frecuencia en muchos robots, por lo que 
es útil aprender cómo calcular sus tensores de inercia respectivos. 


Ejemplo 5.3 
Sea la barra delgada de masa m y longitud L mostrada en la figura 5.6. El sistema de 


referencia indicado se ubica en el punto medio de la barra. Determinar la inercia de 
la barra suponiendo que la masa de la barra se encuentra uniformemente distribuida. 
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Figura 5.6 Cálculo de la inercia de una barra delgada. 


Solución 


Como la masa de la barra se encuentra uniformemente distribuida, dado un elemento 
diferencial dm de la barra con longitud dx, se cumple la siguiente relación: 


dm dx 


m. L 


lo cual implica que dm = mdx/L. De esta manera, empleando (5.7), la inercia Iy de 
la barra con respecto al eje y se obtiene como se indica a continuación: 


L 
T m 
=i 2 pa 2 p 
Iy = fr dm= f'a Taa] 


$ 
L 
ma?|? mL? 
Eli” B 
2 


Nótese que la inercia 7}, de la barra con respecto al eje z es igual a su inercia con 
respecto al eje y, es decir, I} = [,y. Por lo tanto: 


mL? 
lw = =p 
I mL? 

12 


Ejemplo 5.4 


Considérese una placa rectangular de base a, altura b y masa m uniformemente dis- 
tribuida, la cual se muestra en la figura 5.7. Se muestra un sistema de referencia 
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ubicado en el centro de masa de la placa. Determinar el tensor de inercia de la placa 
con respecto al sistema de referencia mostrado. 


Figura 5.7 Cálculo de tensor de inercia de placa rectangular. 


Solución 


Como la masa se encuentra uniformemente distribuida, se cumple que dm/m = dA/A, 
lo que implica que dm = mdA/A. Suponiendo una rotación con respecto al eje z, la 
distancia perpendicular al eje de rotación para cualquier punto seleccionado en la 


placa es h = y, por lo que: 
h2dm = — ri h?dA 
/ Ala 


2 t 2 315 
= ff riug Bi dz 
-47-4 5131; 


mb? f? mab? mb? 


Dila A 


te 


Siguiendo un procedimiento similar al anterior, para una rotación con respecto al eje 
y se obtiene: 


a b a 
3 [3 b [È 
Iy = ST z°dydz = "f z°dz 
4-3 =f 
mb 2217 a ma*b A ma? 
— ALS: DA 12 


Finalmente, considerando al eje x como el eje de rotación, la distancia perpendicular 
al eje de rotación de cualquier elemento de área diferencial es h? = [y? + 2°] , por lo 
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que: 


bd 
m f? fb m fbèz 23] 
= — — + bz°| dz = — | +b= 
A HPE E + a] 5 
mM 2 + 5] _ mab (a? + 0?] om (a? + b?] 
A 12 o 124 o 12 


Debido a la simetría de la placa, los productos de inercia son cero, por lo que se 
concluye que el tensor de inercia de la placa es: 


m[a?+b? 
se aaa 0 0 
Ibiaca = 0 ma 0 
mb? 
0 0 2 iy 


- Ejemplo 5.5 


Sea un disco delgado de radio R y masa m uniformemente distribuida como se indica 
en la figura 5.8, donde se muestra un sistema de referencia ubicado justo en el centro 


de masa del disco. Determinar el tensor de inercia calculado con respecto al sistema 
de referencia mostrado. 


Figura 5.8 Cálculo del tensor de inercia de un disco. 
Solución 


Para determinar el tensor de inercia del disco, supóngase primero que éste se encuentra 
girando con respecto al eje z. Entonces, al tomar cualquier punto sobre el disco, éste 
formará un ángulo 0 con respecto al eje x. Sea r la distancia del origen del sistema de 
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coordenadas al elemento de masa diferencial seleccionado. En este caso, la distancia 
perpendicular de dicho punto al eje de rotación será h = r cos. Para el cálculo de 
la inercia se toma en cuenta únicamente el primer cuadrante del disco y el resultado 
se multiplica simplemente por cuatro para obtener la inercia total. Como en casos 
anteriores, debido a que la masa se supone uniformemente distribuida, se cumple que 
dm = mdA/A. Por lo tanto, empleando coordenadas polares se obtiene: 


4 l f iän] ih i MAA 
A Ja 
4 dm [3 f* 
y EE ef r [r cos 0]? rdrdð = == J E r” cos? Odrd0 
A Jo Jo 


Ffy 4 y 
a E ji ii i. f cos? 0d0 
4 0 A 0 


be 
be 


A 


mR* [7 [1 mR? L.. 7 
= a a" +cos20] d = ZA o+ gain] 


= aa [j+ 3 + 3 sin r| - b+; + -sin o) |- ME 


Nótese que f;¿ = Irz. Finalmente para /,y, la distancia perpendicular al eje de 
rotación es h = r, donde r es la distancia del elemento de masa diferencial selec- 
cionado al origen del sistema de referencia, pudiendo dicho valor variar desde r = 0 
hasta r = R. Por lo tanto, se obtiene la siguiente paa 


m a 27 „2 
ly = 2d, hédA = [rdrd0] 


27 472R 
i ON r drag = Z ES de 
4 0 


E T do ne. ni 
0 


AA TRA F 


Debido a la simetría del disco, los productos de inercia son cero, por lo tanto, el tensor 
de inercia del disco es: 


== 0 0 
Lisco a 0 Sa 0 
o 0 zÆ 


_Ejemplo 5.6 _ 
Sea el prisma rectangular mostrado en la figura 5.9. Utilizar el teorema de Stei- 
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ner para calcular el tensor de inercia del prisma. Suponer que la masa se encuentra 
uniformemente distribuida. 


Figura 5.9 Cálculo de tensor de inercia de prisma rectangular utilizando el teorema de Steiner. 


Solución 


Para el cálculo de la inercia del prisma se puede seleccionar un elemento de volumen 
diferencial dV que corresponde a una placa delgada rectangular como se indica en la 
figura 5.10. 


3 . 


Figura 5.10 Elemento de volumen diferencial. 


Suponiendo que la masa del cuerpo se encuentra uniformemente distribuida, se obtiene 
la siguiente relación: 


lo cual implica que: 
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Para el cálculo de la inercia con respecto al eje z, la placa se encuentra a una distancia 
x del eje de rotación y, del resultado obtenido para la inercia de una placa rectangular, 
es posible deducir que la inercia de éste elemento de volumen diferencial es dI., = 
b?dm/12, por lo que aplicando el Teorema de Steiner se obtiene dicha inercia con 


respecto al sistema de referencia mostrado en la figura 5.10: 


dI 


>> 
zz 


á b? 
dI., + z?°dm = 5 + 2?]| dm 


| 
| 
+ 
= 
E 
e 
yg 


por lo tanto, para obtener el momento de inercia del prisma con respecto al eje z 
simplemente se integra dI.. a lo largo del eje x: 


ri 12 


m-ni E :| PAE AA 


a 
-5 
2 


Siguiendo el mismo procedimiento anterior se obtienen los siguientes resultados: 


dí, E 
vy = T3 m 
- e? 
dlyy = di,y +z*dm = p + e dm 


por lo que: 


f fe m [a? + e? 
lm= 2 f [S+r] a 27 
a -Ú 12 12 


Ahora, para el cálculo de Izr, se observa de la figura 5.11 que: 


Como en éste caso no existe distancia adicional al eje de rotación, se procede a calcular 
la inercia directamente: 


m [7 d+ m [b? + (? 
PES o A 
a 


12 12 


=z 
2 
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Figura 5.11 Cálculo de inercia con respecto al eje x. 


Nuevamente, debido a la simetría, los productos de inercia son cero, por lo que el 
tensor de inercia de la pieza es: 


m 2 c? 
S 
Lrrisma zag 0 al 0 
mla?+b2 
0 0 mfa* +e] 


Sea un cilindro de radio R y altura L como se muestra en la figura 5.12, donde el 
sistema de referencia mostrado se ubica en el centro de masa del cilindro. Suponiendo 


que la masa se encuentra uniformemente distribuida, determinar el tensor de inercia 
del cilindro. 


Figura 5.12 Cálculo de tensor de inercia de cilindro. 
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Solución 


Para el cálculo de la inercia del cilindro puede seleccionarse un elemento de volumen 
diferencial como el que se muestra en la figura 5.13. Como la masa del cilindro se 
encuentra uniformemente distribuida, se puede establecer la siguiente relación: 


dm dV 


< 
3 
po] 
N 
~ 
~ 


Figura 5.13 Selección de elemento de volumen diferencial para un cilindro. 


Empleando el resultado del cálculo de inercia del disco, se deduce que para el eje z: 


y, aplicando el Teorema de Steiner, se obtiene la inercia de dicho disco con respecto 
al sistema de referencia mostrado en la figura 5.13: 


2 2 
= fam + z?°dm = E ES e dm 


por lo que basta con integrar a lo largo del eje x para obtener la inercia del cilindro 
con respecto al eje z: 


L E 
7 [R? m |R? 29]? 
oa A Ama E la 2 z] 
1 £ m A A +r“ | dr 17 +3 => 
m [R?L a m 2 2 
r a a 
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Nótese que ly = I++. Finalmente, para el cálculo de Izz se tiene: 


2 2 
dlzz = Tis = S A 
2 2 L 


por lo que, debido a que no existe distancia al eje de rotación del sistema de referencia 
deseado, se obtiene: 


lsz a 


2L da 


mR? / + mR? 
-£ 2 


Como en casos anteriores, los productos de inercia son cero, por lo que el tensor de 
inercia del cilindro es: 


E 0 0 
Ieitindro 0 5 [3R? + L?] 0 
0 0 m [3R2 + L?) 


Sea el cono circular recto mostrado en la figura 5.14, el cual tiene una masa m uni- 
formemente distribuida, radio R en su base y altura h. Además, el sistema de referencia 
mostrado se ubica en el extremo superior del cono. Determinar Irz, Iyy e Izz. 


Xx 


Figura 5.14 Cálculo de inercia de un cono circular recto. 


Solución 


Para el cálculo de la inercia del cono puede seguirse el mismo procedimiento que en 
el caso del cilindro mostrado en el ejemplo anterior. Para ello es posible seleccionar 
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un elemento de volumen diferencial, el cual es nuevamente un disco de radio r como 
se muestra en la figura 5.15. Para dicho disco se obtiene la siguiente relación: 


dm dV = ar?da eS 3r? 


Figura 5.15 Selección del elemento de volumen diferencial para un cono circular recto. 


De la figura 5.15, es posible obtener la siguiente expresión: 


a|s 
II 


lo que implica que r = Rx/h. Sustituyendo este valor de r en dm se obtiene: 


: 2 
3r2m 3 [4] m 3x?°m 
dm = RER dz = — £ a du 
Empleando el resultado del cálculo de la inercia de un disco, se obtiene: 
2 
dl. = dm 
i p [4 
dI.. = dl., + xz°dm = 5 + »| dm = es + 2?| dm 


| R?a? 


R 
IR + e dm = 5 + 1| xr°dm 


e integrando a lo largo del eje x se llega a: 


B F 2 mia 
Ia = H nijfe dm EZS $ | 73 dx 
h 2 57} 
R 3m| |x 
4 
ES 55] / + de (+ +1] ES [š], 


3mh? [ R? 3m |R? i 
SS +1] Fe 
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Por simetría se concluye que Iy = I++. Finalmente, para la inercia con respecto al 
eje x: 


A [52] A Es z| 


= y R? x°] [32m 3mR? , 
dl q óm q 73 | | | | dx 


2h? h? TITS 
por lo tanto: 


Izz a 


3mR? a aa 3mR? [15]* B 3mR? 
I Jo" 2h 15], 


Finalmente, los valores deseados de inercia son: 


3mR? 3m [ R? 2 3m | R? 2 
E AE a e) Enel 


PERA 


Sea la esfera de radio R y masa m uniformemente distribuida que se muestra en la 
figura 5.16, donde el sistema de referencia indicado se ubica en el centro de masa de 
la esfera. Determinar el tensor de inercia de la esfera. 


Figura 5.16 Cálculo del tensor de inercia de una esfera. 


Solución 
De la figura 5.16 se observa que r? = R? — x?, mientras que: 
d dV rr?da 
m= —m= -m 
V ITR? 
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por lo que al sustituir el valor de r en dm se obtiene: 


ar2da 3m [r? - x°] dx 
= ——— m 


ma — a 


Empleando los cálculos de inercia de un disco se obtiene el siguiente resultado: 


por lo que la inercia de la esfera con respecto al eje x se obtiene integrando a lo largo 
de dicho eje de la siguiente manera: 


baa f 3m [R? — a _ 2mR? 
-R 8R? 5 


Debido a la simetría de la esfera, todos los cálculos de inercia son equivalentes, por lo 
que: 


2mR? 
Irz = Iyy =I: = 
5 
Nuevamente los productos de inercia son cero, por lo que el tensor de inercia de la 
esfera es: 


2m R? 
Š A a " 2m R? | 10% ] 2mR? 
Losfera = 0 E 0 == 5 0.10 a 5 3x3 
0 0 2mR? | 00 1 ] 


donde I}x3 denota la matriz identidad de 3 x 3. 


e 


En los ejemplos anteriores pudo observarse una característica importante del tensor 
de inercia, en la cual, cuando dos ejes del sistema de referencia considerado forman 
un plano de simetría con la distribución de masa del cuerpo, se obtiene I;; = 0, para 
i A j. Además, los momentos principales de inercia siempre son positivos, mientras 
que los productos de inercia pueden tener cualquier signo. También puede verificarse 
que la suma de los tres momentos principales de inercia es invariante a los cambios 
de orientación del sistema de referencia. 


Anteriormente se realizó el análisis para obtener ecuaciones que permiten calcular 
posición, orientación y velocidades de un robot manipulador. Sin embargo, cuando se 
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trata la dinámica de un manipulador, se debe analizar el conjunto de fuerzas o pares 
que provocan su movimiento. Entonces, deben tenerse en cuenta no solo los cálculos 
de velocidades, sino también de las aceleraciones que se producen en el robot. 


Sea un cuerpo rígido C y p € C un punto fijo del mismo. Al igual que en casos 
anteriores, se emplea un sistema de referencia (A) para describir el comportamiento 
del cuerpo rígido. Entonces, dado un sistema de referencia {B} unido al cuerpo rígido, 
la posición de p en {B} se representa por př, su velocidad lineal por vs , y la velocidad 
angular de C por w^. Las aceleraciones angular y lineal corresponden a la derivada 
con respecto al tiempo de la velocidad angular o lineal, respectivamente. 


En el desarrollo de velocidad lineal total y velocidad angular total, el objetivo 
fue obtener una fórmula que permitiera calcular directamente dichos vectores de ve- 
locidad. El objetivo del siguiente análisis será extender éstos procedimientos para 
calcular aceleraciones lineales y angulares, así como obtener relaciones que involu- 
cren las fuerzas y pares que producen el movimiento del sistema. A partir de éstas 
relaciones, se obtendrán las ecuaciones dinámicas de los robots manipuladores. 


5.3.1 Aceleraciones lineal y angular 


Es importante recordar del análisis realizado para el cálculo del Jacobiano que, dado 
un punto p, éste puede representarse en el sistema de referencia {B} mediante el vector 
př. Dado el sistema de referencia {A}, el cálculo de la velocidad lineal del punto p 
expresado en el sistema {A} consta de tres elementos: uno que determina la velocidad 
del origen de {B} con respecto a {A}, otro que determina la velocidad del punto en 
el mismo sistema de referencia {B} y otro debido a la velocidad lineal inducida por 
el movimiento rotacional de {B} con respecto a {A}. Suponiendo inicialmente que el 
origen de {A} coincide con el de {B}, se obtiene la siguiente expresión para el cálculo 
de la velocidad lineal del punto p: 


vi = RĝvË + w8 x Råp? 


o bien: 
d 
A_ AB] — pA,yB A AB 
Vp = Ti [Rip ] = Rv, + WB Xx RBP 
La derivada con respecto al tiempo va del vector wi corresponde a la aceleración de 


př, vista desde (A), cuando los orígenes de (A) y {B} coinciden: 


s = E [Riv] +08 Rgp? +w x E [Rgp?) 


a : í d 
= REvP4+Riv? +ùĝ x Rip? +wĝ x z [Rip”] 
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y dado que Ri = S(w) R$, se obtiene: 


va = REV + wE xX x RE B + x Rip? + wé Xx [Ri v? +wé x Ríp?] 


REV e +o x Rp? FUS X [13 x Rp e] 


La ecuación anterior permite calcular el vector de aceleración lineal cuando los orígenes 
de los sistemas de referencia {A} y {B} coinciden. 


Para un caso general, el cuerpo rígido considerado tiene asignado un sistema de 
referencia {B} y experimenta rotaciones y traslaciones con respecto a un sistema de 
referencia {A}. Por lo tanto, la aceleración de p” con respecto al sistema de referencia 
{A} se obtiene agregando a E la aceleración del origen de {B}, representada por 


vá . como se indica a continuación: 
o 


v, = vé, + RYS + 2w% x REV? + 0% x Rép? +w x [w$ x Rp”] (5.10) 
Para movimientos rotacionales, se sabe que los vectores de velocidad angular pueden 
sumarse siempre que se expresen en el mismo sistema de referencia. Sean los sistemas 
de referencia {A}, {B}, {C}. Se supone que éstos sistemas se asignan a los eslabones 
de un robot y que {B} rota con respecto a (A), y {C} rota con respecto a {B}. 
Los vectores de velocidad que describen los movimientos rotacionales son wi y wë 
Entonces, el vector wå que relaciona el sistema de referencia {C} con {A} puede 
expresarse como: 
wå = =wå + Råwë 


Empleando nuevamente la relación R = S(wf)RF, la derivada con respecto al tiem- 
po de wf corresponde a la aceleración angular ùf, la cual se calcula de la siguiente 
manera: 


of + R4 Sua + Rag 
of +wé xX R4 Sue + RAGE (5.11) 


oe 


Volviendo al punto de las fuerzas y pares que causan el movimiento de los eslabones 
de un robot manipulador, se sabe que el comportamiento de un cuerpo de masa m 
puede describirse suponiendo que se tiene una partícula de masa m ubicada en el 
centro de masa del cuerpo rígido. Bajo esta consideración, si se aplica una fuerza F 
en el centro de masa del eslabón, éste experimentará una aceleración lineal v.(t) que, 
de acuerdo a la segunda ley de Newton es: 


F = mv. (5.12) 


donde v.(t) es el vector de velocidad lineal del centro de masa del eslabón. 


Por otra parte, si un momento N actúa en el centro de masa de un eslabón, éste 
rotará con respecto a un eje. En el análisis de la Sección anterior se comprobó que 


dicho momento es: 
N =ù +w x Iw (5.13) 
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donde w(t).w(t) corresponden a la velocidad angular y la aceleración angular del es- 
labón, respectivamente, e IC es el tensor de inercia del eslabón calculado con respecto 
al sistema de referencia {C}, cuyo origen se ubica en el centro de masa del eslabón. 

Ahora se desarrollará un procedimiento que permite determinar los pares y fuerzas 
que actúan en un robot manipulador, con base en el conocimiento de las posiciones de 
los eslabones, sus velocidades y aceleraciones, así como la información de la distribu- 
ción de masa del manipulador y su cinemática directa. El procedimiento se dividirá 
en dos partes: (1) un enfoque externo, y (2) un enfoque interno [1]. 


5.3.2 Cálculo de fuerzas y pares: enfoque externo 


Si se conoce la velocidad rotacional, la aceleración lineal y la aceleración rotacional, 
es posible determinar las fuerzas y pares que actúan en un eslabón de un robot. En 
la unidad del Jacobiano se estudió el método denominado propagación de velocidades 
que, en el caso de articulaciones rotacionales, indica que el valor de la velocidad 
angular en el eslabón ¿+ 1 está dado por la siguiente expresión: 


witi = Rial + Ó 1201 (5.14) 


En la ecuación (5.11) puede considerarse que {C} se asigna al eslabón ¿i + 1, y que 


{4} = {B} = {i}. Entonces, la aceleración angular wf, del eslabón ¿+1 con respecto 


al sistema de referencia {i} se obtiene a través de la siguiente expresión: 
IA O DA to 
Wiy] S Wi T Wi X Wigi T Wiga 
Multiplicando la expresión anterior por la matriz de rotación Ri" se obtiene: 
.i+l _ pi+l ei il iĝ +11. „itl 
ej = Ri wit Ri iy +01 Zi (5.15) 
Cuando la articulación ¿+ 1 es prismática, la expresión (5.15) se reduce a lo siguiente: 


¿el — pi+l- 
wip = Ri wi 


Al igual que con la aceleración angular, considerando articulaciones rotacionales, la 
aceleración lineal del origen de cada sistema de referencia asignado a los eslabones 
puede calcularse empleando la fórmula (5.10), con lo que se obtiene: 


viti p iii [v; +0; x Pi+1 +w; x [w; X Pi+1]] 
donde p:, , es el vector de posición del origen del sistema de referencia {i +1}, desde 
el origen de {i}. 
Cuando la articulación ¿+ 1 es prismática, empleando (5.10), se obtiene: 
YE = RH [ob Hui x [ui x pial] + uiti deal del 
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De la misma forma, la aceleración lineal del centro de masa de cada eslabón puede 
obtenerse por medio de (5.10) como se indica a continuación: 


vi = vitai xpi + ut x [wi x pi] (5.16) 


Ci 


donde Pi, es el vector de posición del centro de masa del eslabón į con respecto al 
sistema de referencia {i}. 


Una vez que se conoce el valor de las aceleraciones lineal y angular del centro de 
masa de cada eslabón, pueden emplearse las ecuaciones (5.12) y (5.13) para determinar 
la fuerza F; y el par N; que actúan en el centro de masa de cada eslabón, por lo tanto: 


Fi = MiVe, 
Ni = Id; + wi x Iw 


donde {C;} es un sistema de referencia que tiene su origen en el centro de masa del 
eslabón i, y posee la misma orientación que el sistema de referencia {i}. 


5.3.3 Cálculo de fuerzas y pares: enfoque interno 


Al igual que en el procedimiento de retropropagación de fuerzas y pares, si se conocen 
las fuerzas y pares que actúan en cada eslabón, es posible calcular los pares que deben 
ejercer las articulaciones para obtener las fuerzas netas aplicadas a cada eslabón. Lo 
anterior se logra empleando un balance de las fuerzas y momentos. 

Considerando que F;, N; son la fuerza y el momento que actúan en el centro de 
masa del ¿-ésimo eslabón, respectivamente, y que f;, n; son, respectivamente, la fuerza 
y el par ejercidos en el eslabón i debido al eslabón i — 1, la suma total de fuerzas y 
pares debe ser igual a cero. Por lo tanto, para el sistema de referencia {i} se obtiene: 


Fi a fi j afir (5.17) 


f s n; = ai T [-pc,) x E am (Pis z pc.) x fi (5.18) 
Nótese que nį; = Ri,,n;?;, y si se despeja ff de (5.17) y se sustituye en (5.18), se 
obtiene: 


NÌ =ni- Riant = Po, x Fi- Piy x Rafa (5.19) 


Nuevamente, empleando la expresión de ff de (5.17) y nt de (5.19), se obtienen las 
expresiones: 


f = MA + Fi (5.20) 


n = Ni + Rinit + po, X Fi + pip X Rif 
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Finalmente, al igual que en el método de retropropagación de fuerzas y pares, se 
calcula la componente correspondiente a los pares de las articulaciones, usando el 
producto punto entre el eje de acción de las articulaciones y la fuerza o par corres- 
pondiente, obtenida de (5.20). Por lo tanto: 


- GE : : ; 
z; „articulación rotacional 


(5.21) 


=} [ni 
s [ni] f} , articulación prismática 


y si no se considera que el efector final del robot tiene contacto con el medio, entonces 


fiti = nit] = 0 para un robot de n GDL. 


5.3.4 Resumen del cálculo de fuerzas y pares 


El procedimiento anterior para determinar los pares de las articulaciones se puede 
resumir en los siguientes dos pasos: 


1. Determinar las velocidades y aceleraciones lineales y angulares de los eslabones, 
desde el eslabón 1 hasta el eslabón n. Este paso engloba lo indicado en el enfoque 
externo. 


2. Calcular las fuerzas y pares de las articulaciones, desde la articulación n hasta 
la primera articulación. Este paso engloba lo indicado en el enfoque interno. 


Como el procedimiento anterior se basa en el uso de la ley de Newton (5.12) y la 
ley de Euler (5.13), el conjunto de ecuaciones obtenidas para determinar los pares de 
las articulaciones se denomina Método de Newton-Euler (NE). A continuación 
se resumen las ecuaciones que deben emplearse en cada caso, dependiendo de si la 
articulación considerada es rotacional o prismática. 
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Método de Newton-Euler para articulaciones rotacionales 


elo i+1 

= Ri wi + 0412541 

i+l -i AE A AE E. i+l 

=R; oit Ry wi X Oiyza + 041271 

— pi+l [i i i R i .i 

= Ri [oi x pii +wi x [w; x pi,1] + v!] 
+1 i+l i+1 i+1 i+1 


Enfoque 
ci+1 


externo a o ia X POr T Oiti X [Witi X Poe] T Yit 


1 «¿41 
= Mi+iWVe,, 
_ q i+r p i+ ¡i41 Ci4t, i+1 
= Lia twi XL Wip 
(5.22) 


kes 7 i+l i 
Enfoque a if ü En i i i i i+l 
1 rt ? t t 1 1 t 
Interno n; = Ni + Ri+1M;31 + Pc, Xx Fi; + Piti Xx Rii fizi 


ti = [n}] z; 


(5.23) 


Método de Newton-Euler para articulaciones prismáticas 


vigi = Ri [vi +o] x pi +w x 
“nfoque | } i+1 7 i+1 
Enfoqu +H2wiji X digg + dig 1241 
externo 


1 .i+1 
= Mi+1Vc,,, 

_ 1 ist itl i+l Ci+1, i+1 

Lgi ipi t Wip X lipi Wip 


i pi gi+l i 
¡a ip Tii : : ; i i+1 
ni = N? + Rip + Po, x Fi + pip X Rip 


n= [8] a 


Enfoque 
interno 


Finalmente, en general los eslabones del robot experimentan pares debidos a la gravedad. 
Dicho efecto no se ha incluido en las ecuaciones de NE. Sin embargo, si se supone 
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que la base del robot se acelera en sentido contrario al vector de gravedad, la reacción 
a dicha aceleración en los eslabones corresponderá al efecto de la gravedad. Por lo 
tanto, si a la base se le asigna el sistema de referencia {0} y g es el vector con sen- 
tido contrario al de la gravedad, se supondrá que la aceleración de la base del robot 
es v8 = g’. De esta manera, las ecuaciones de NE incluirán el efecto de los pares 
gravitacionales. 


En conclusión, las ecuaciones de NE permiten calcular las velocidades y acelera- 
ciones de los eslabones, las fuerzas y pares que actuán en su centro de masa, y los 
pares que deben ejercer las articulaciones. Al obtener el valor del par 7; para la ¿-ésima 
articulación, lo que realmente se obtiene es una de las n ecuaciones diferenciales que 
describen la dinámica del robot manipulador de n GDL. Por lo tanto, al aplicar ésta 
metodología se obtendrán las ecuaciones dinámicas del robot manipulador. 


A continuación se presentan dos ejemplos que ilustran la manera en que deben 
aplicarse las ecuaciones de NE, y obtener las ecuaciones dinámicas de un robot ma- 
nipulador. 


Ejemplo 5.10 


Como primer caso, considérese el robot manipulador planar de 2 GDL, con articula- 
ciones rotacionales, mostrado en la figura 5.17. Para simplificar el uso de las ecuaciones 
de NE, en éste primer ejemplo se supondrá que la masa de los eslabones se concentra 
en los puntos A, B, ubicados en los extremos de cada eslabón. Las masas de los es- 
labones son mı, mo para el eslabón 1 y 2, respectivamente. Emplear las ecuaciones de 
NE para obtener las ecuaciones dinámicas del robot, suponiendo que el efector final 
no tiene contacto con el medio [1]. 


Figura 5.17 Robot manipulador de 2-GDL para cálculo de ecuaciones dinámicas empleando las 
ecuaciones de Newton-Euler. 


Solución 


Para resolver el problema, primero se ubican los centros de masa de los eslabones. En 
este caso, los centros de masa se ubican en los extremos superiores de cada eslabón. 
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Empleando la asignación de sistemas de referencia indicada, se calculan los vectores 
que ubican los centros de masa de los eslabones de la siguiente manera: 


15] 


o] 
05 lel 
o, 


Como se supone que la masa de los eslabones se concentra en sus extremos, se concluye 
que la masa es puntual, por lo que los valores respectivos de sus tensores inercia son 
nulos, es decir: 

1% =0,15 =0 


El robot considerado es de n = 2 grados de libertad. Como el robot realiza sus 
movimientos sin interactuar con el medio, no existe ninguna fuerza o par que actúe 
en su efector final, por lo tanto: 


n+l — -. PUE 
fn+1 m f3 =0 

n+l en 3 
Na+ 5. MA 0 


y como la base del robot es fija, entonces: 
0 -0 
wo = 0, wo = 0 


Para incluir dentro de las ecuaciones el efecto de la gravedad se considera que la base 
del robot se acelera con una magnitud g. De acuerdo a la figura 5.17, La dirección 
natural del vector de gravedad es a lo largo del eje yọ negativo. Por lo tanto, se 
supondrá que la base del robot se acelera con dirección opuesta, es decir: 


Para los cálculos posteriores es necesario contar con los parámetros cinemáticos del 
manipulador, los cuales se obtienen empleando los parámetros DH mostrados en la 
tabla 5.1. 


Tabla 5.1 Parámetros DH de robot manipulador de 2-GDL. 


[+ loss || ais || d: || 0: | 
pio fo fo [fa | 
2 po f4 [0 |[® | 
{3lo fe fo fo 
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Las matrices de transformación homogénea del robot son: 


KE -54 0 0 os -s 0 h [1.004] 
0 $1 C] 0 0 Mu S2 C2 0 0 , VO 0.1.0.0 
qe 0 0 1.0 a E YA T3 0010 
0 0 1/11 0 0 0 1 0.0.0 1 


El siguiente paso consiste en aplicar las ecuaciones de Newton-Euler al robot ma- 
nipulador. Como se trata de un robot con articulaciones rotacionales, se emplearán 
únicamente las fórmulas (5.22)-(5.23). Se comienza aplicando el proceso con el enfoque 
externo, y se aplica el procedimiento desde i = 0 hasta ¿=n-—1= 1. 


a Enfoque externo con i = 0: 


¡+1 i+l i À. gitl 
wigi = Ry wit Oiz 


i+1l 
0 
wi = Rwo+ôÂzi=]j 0 
0; 
oti PEA R uix il iatt 
F .. 0 
AE | 0 
0; 
Ya = RP [bi x Pip +w; x [wi x Pi] + vi] 
Y = R} [og xp}? +w? x [w8 x p}] + 92) 
cı sı 0 0 gsı 
= — $1 C1 0 g = gcı 
0 0 1 0 0 
ah = all, toti [eiti xpa] ih 
Vo, = ùi xpo, +wi x [wi x po,] + Y; 
0 l 0 0 ly 2a 
= [O0|x|0[+|0Jfx[[0]x il [E 
0; 0 0 "i 8 > 
gs] — 1,07 
= gcı + l0: 
0 
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HA = Miti Ý, 
mıgsı — mıh 0? 
Fl = mitb, = | mıgcı + mlb 
0 
NE = Eroh +u x Grun 
Eb 
NÌ = Foj+wxhfw=|0 
Lo] 
a Enfoque externo con i = 1: 
w2 = Riw! + az? 
ca =s, 0 dd: 0 
= S2 Ca 0 0 + 0 
0 0 1 0, 02 
0 
= 0 
01 +03 
ù = Río] + Ríw! x z3 + Daz? 
Ca —$S» 0 d 0 
z 82 C2 0 0 
0 0 1 0; 
Co —S2 0 x 0 0 0 
+ S2 Ca 0 0 x 0 + 0 
0 0 1 0, 02 b2 
0 
— 0 
01 +02 
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w = Ri [o] xp3+0u] x [wi x p2] + v]] 


Ca —s2 O á 0 l 1 
= S2 Co 0 0 > 0 + 
0 0 Ë, 0 


Ca $2 
-82 (2 0 ger y 110, 
o ouall 

l 10182 — l 107c2 + 9812 

hiic + Lisa + ger2 


p 
Lo 
mp i 
l 
da 


T S S 2 2.2 ..2 
VE, = w2 X Po, tw? xX [w3 x Po] + Y3 


0 lz 0 0 
m 0 y Xx 0 ¡+ í 0 x l 0 
0, +05 0 0, +0, 0, +05 


| 1,6182 el 10%, + 9812 | 


lico + l1Å2s2 + 9C12 
0 


0 0 
ula + Öz | i, ti | x P + A | 


l 10, so—l CHE + 9812 


+ f bre rhaa + gc12 
Pr tes | 
| | dd 
| 
| 


2 
1,0, 82 — 11020, + 9812 — la $ + 0, ] 


Sl | [licz + la) Öı + hts +h Å? so + gcas | 
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110182 — l 18?c2 + gs12 


ea). i [+ + | nipae taen | 
| 
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a a h 2 
F = mý, 


məlıĝıs2 — mal ¡07 ca + mags12 — mala [ó, T A 


ma [licz + l2] 6, + maloba + mal¡0?s, + moa9C12 
0 


N? s 1522 eS w2 x «Pu? =0 


Hasta este punto se han utilizado las ecuaciones para el cálculo de velocidades, acele- 
raciones, fuerzas y momentos, por medio del enfoque externo. Ahora se emplearán las 
ecuaciones correspondientes al enfoque interno. Se sabe inicialmente que los valores de 
f? y nł son nulos. Para emplear las fórmulas (5.23) se aplica el procedimiento desde 
i=n=2 hasta į = 1, como se indica a continuación, 


a Enfoque interno con ¿= 2: 


r r 4 . Ta 
| mal101,52 — mal101ca + M29812 — mala g + A ] 


2 _ p2ç3 2 p? 3 $ a 
fo = Rifa + Fs = F3 = | ma [licz + l2] 01 + Molz + Mmal10? s2 + mager2 


0 


n = a Ali 


m Sy . . 12 
e = mol10? cə + M29812 — Mols [ó, + A ] 


ma [li ca + lə] Ó, + mala0s «$ mal10?s) + ma9C12 
0 


0 
0 
mala (licz + l2) 0, + mal30s + mal1l20?5, + malogcr2 


[n2]* 23 
| ? MEA 
1 


| mala [lica + lə] Ó, -+ mal30, uN malr120?s9 + mal2gc12 | | 


T2 


mala [licz + l2] 0, «+ mal20, + malr120?s) + mal29C12 
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a Enfoque interno con ¿= 1: 
fi = REFE 


a . A . 12 
co -s2 0 | mal10,52 — mal10] c2 + M29812 — Mala [ó, + A 


Il 
va 
N 
Q 
y 
© 


0 1 | ma [lic2 T lə] Ó, T molz T mal10s) + m29C12 
0 


0 
+ | mıgcı + mlb 

Wina t 
f —mala0,52 — mai asm [ön + AN C2 + M2981 ] 


As a a . 12 
o | ma [ha + l2c2] 01 + mal202c2 — malo» g + A $2 + M29C1 | 


0 
n) = Ni+Rim+po, x Fi +p x Rif 
C2 —S2 0 0 
= $2 Ca 0 0 
0 0 1 mal> [li ca + l2] 0i + mal30, + mal1 120782 + mal29c12 
ly m1981 — myl,0% 
+j 0 ¡xj mgc + mlb 
0 0 
A A : P e 
lı ; mal10152 — m2l10?c2 + M29812 — mala ó + A 
P > e R2 ma [l, ca + lə] Ó, + molo0s + mal 078) + ma9C12 
0 
[o] 
= 0 
[x] 
K = [mE + mal; + mal + 2mal1 l2c2] Ó, «> [maly laca «+ mal3] Ü, 


—2məlıl2010282 - məlıl2ġ2s2 a [milic + mala3012 + mal¡c1] g 
Y 
m = [ni] 2 
— [2mal1 laca > mall + ml? > mal?) Ó, af [mal} T molılzc2] bo 
A è . 12 
+mal1l207 s2 + mal2gc12 + [mi + ma] ghici — məlıl282 ó; + A 


= [mE T mol? F mal F 2məlıl2c2] Öö T [molil2c2 + mal3] 0, 


—2mal1 12010252 - malrl202 sa + [mil cı + mal2c12 + mal¡c1] g 
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Finalmente, de acuerdo a los cálculos realizados anteriormente es posible escribir las 
ecuaciones dinámicas del robot manipulador de la siguiente forma: 


Tı = [m, 17 + mol? + mal + 2məlıl2c2] Ó, + (mal, laca + mol3] A = 2məlil2ĝ 2S2 
-məlıl203s2 + [mlc + Malzc12 + M2l161] g 
T2 = Mmal2 [l,c> + l2] Ó + mató, + molıl20?s2 + mal2gc12 


Defínanse las matrices: 


Miga mil? + ml? + mal + 2məlil2c2 mələz |l1c2 + la) 
mala [l,c2 + l2] mal? 
N 0 —mal1 los = —mMəlıl2s2 
c(a) = | moliloso 0 | i Bla) > l 0 | 
_ | [Mmilhci + mal2c12 + Mal1c1) g N E 
e | mal39C12 bl T2 


Empleando las matrices anteriores, las ecuaciones dinámicas del robot manipulador 
se pueden escribir como: 


72 . . 
M(q)a + C(q) | y | + B(q)0102 + G(q) =T 
2 


La matriz M(q) es la matriz de masa del sistema, C'(q) corresponde a los pares 
centrífugos, B(q) a las fuerzas de Coriolis, G(q) es el vector de pares gravitacionales, 
y T es el vector de pares de entrada o de control. 


Ejemplo 5.11 


Emplear las ecuaciones de Newton-Euler para determinar las ecuaciones dinámicas 
del robot manipulador PRR mostrado en la figura 5.18. 


Figura 5.18 Ecuaciones dinámicas para robot PRR. 
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Solución 


Empleando la asignación de sistemas de referencia de la figura 5.18, se obtienen los 
parámetros DH del manipulador, como se muestra en la tabla 5.2. 


Tabla 5.2 Parámetros DH para robot manipulador PRR. 


[1.0.0 L a -s 0 o] 
o (0 10 © "O 0 0 1 Za 
ds 0.0 1 d pa -8 -aq.0.0 
000 1 0 0 0 1 
cas sa 0 0 i ô 


o 
o 
Oo-=oo 
oso 
——) 


El producto de las matrices de transformación anteriores permite obtener: 


100%h]|[. -s2 0 o] 
jie ss on 010.0 0 0 1 Lə 
T = N= 0.0 1 d pa -c 0 o | 

000 1 | 0 0 0 1 | 

| Ca — 82 0 Lı ] 
o | 0 0 1 La | 
al —-83 —C2 0 dı 
| 0 ~ 0 1 | 
Co $892 0 Lı C3 —83 0 0 
0 _ mop 0 0 1 L 0 0 -1 -L3 
T3 q? T3 T3 z 52 —C2 0 dı $3 c3 0 0 
0 0 0 1 0 0 0 1 
Cala —C283 S2 Li + L3s2 
O 53 C3 0 La 
E =S203 S283 C2 dı + L3c2 
0 0 0 1 
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CaC3 —C983 82 Lı + L3s2 ] 10 0 0 ] 
o mMm 53 c3 0 Lə 06100 
To TaT; E | ~= 8203 S2583 Ca dı + L32 | | 0 0 1 Le | 

0 0 0 1 ] Lo 00 1 | 


| 0203 =c983 S2 Li+ [L3 F Le) s2 ] 


Il 


S3 C3 0 La 
—$2C3 8283 C2 dı gg [Ez e Le] C2 
0 0 0 1 


lo cual completa el análisis cinemático del manipulador. Ahora se emplearán las ecua- 
ciones de Newton-Euler para articulaciones tanto rotacionales como prismáticas. Se 
supone que los vectores que ubican los centros de masa de los eslabones son: 


0 0 0 
ph, =| 0 |;P =]| 0 |,pré,=| 0 
=l; =l la 


Ahora se consideran los sistemas de referencia {C;}, i = 1,2,3, donde la orientación de 
[C;) es la misma que la de {i} y el origen de {C;} coincide con el centro de masa del 
eslabón ¿. Empleando éstos sistemas de referencia se obtienen los tensores de inercia 
de los eslabones, los cuales tienen la siguiente estructura: 


3 [ La, 0 0 
I“=| 0 1, 0 [,i=1,2,3 
"TA FA ” 


donde 17 es el tensor de inercia del eslabón ¿ calculado con respecto al sistema de 
referencia {C;}. Además, como no se considera que el manipulador se encuentre en 
contacto con el medio y la base del robot es fija, se concluye que: 


g 
f= 0ni = 0, 05 = 0,08 =0,v7 = | 0 
0 


Aplicando las ecuaciones de Newton-Euler, se comienza con ¿ = O para el enfoque 
externo, con la primera articulación prismática: 


wi = Rio) = 


O: DARE 
wi = Rowo =0 


Y = R [VI+ ag x p? + we x [w8 x p?]] + 2w} x dizi + dizi 
o DS o] | o ] o] 

= re+ázi=| o r o) Joje] o=] 0 
loo 1] lol lal lál 
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.1 -1 1 1 1 1 .1 | 
vb, =ù] xph, +wi x [wi x ph] +t = | y 


m19 
Fin mvt, = 0 
mid; 


N) = Iùl +w x Iw =0 


Para į = 1, considerando que la segunda articulación es rotacional, se obtiene: 


w = Rèu! +Â: 
T 
co =a 0 0 0 0 
EPA Kbal] 
|- -a o] Lo] li] Lä] 
Ñ 0 
w3 = Riw] + Riw] x 6223 +03 = | 0 
02 
Y = Rol x pitw x lol x pi] +0] = RE 
Ca 0 —$92 g gc — dis 
= =p 0 — C2 0 = —GS2 — d1Ca 
0 1 0 dı 0 
Vo, = 03xp0, +w X [w3 x Po] + v2 
0 0 0 0 0 
a telal d delile iteka N 
Lal] l-a] lal Ilaj l-l] 
ges — di s2 
+ | —gs2 — dıc2 
0 
0 -0 0 0 
= 0 0 0 0 
0 0 0 -l2 
0 =ġ> 0 O = 0 0 ges = ds» 
T 0, 0 0 0, 0 0 0 a —gs2 — dica 
0 0 0 0 0 0 -l2 0 
gez — di s2 
a =g82 — dıc2 
0 
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mM29C2 — Mad 82 


2 ..2 
F; = M2V C, = | =M29 S2 — madCo 
o] 


N? = otw? x 172 
Ia E 0 0 0 Fui: € 0 0 
= 0 ly 0 0|+[|0 |x| 0 I 0 0 
0 0 L Öz 0, 0 0 L 0, 
0 0 -Å 0 0 0 
I-02 0 0 0 12,02 202 


Finalmente para ¿ = 2, con la tercera articulación que es rotacional, se obtiene de las 
fórmulas del enfoque externo: 


Riwi + 0323 


wa = 
c3 0 s3 0 e i. 0253 
= —$3 Dc 0 +03 0 = 0303 
o s ollk 1 Ós 


W = Ro? + Rw x 0323 + 0322 
C3 0 $3 0 C3 0 $3 0 0 0 
= — 83 0 3 0 + — 83 0 cd 0 Xx 0 + 0 
0 -1 0 Ë 0 -1 0 0, Ås UN 
0283 0 0 0203 0 0 
= dacz | + 0 0  —Ó253 0 ¡+0 
0 docs 0, S3 0 03 Öz 
Özs3 070303 0 0253 + 020303 
a Özcz3 | + | —Ó20353 | +| 0 | = | Özc3 — 020383 
0 0 Öz 03 
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v3 = Ri[ozxp3+u3 x [03 x p3] + v2] 
¡3 ollo! Es 
= 53 c3 E A aa 
Lo o] lal [o] 
0 0 gce ~ d,82 
0 x —Ly + IS) ~ dicz 
0, j. 0 0 
YgCatz — dis2c3 + Labac3 
= —gc283 + d18283 — L32833 
gs82 + dicz m L302 
Vo, m w3 x Po, + w3 X x [w3 x a + vi 
0253 + 020 303 0253 0253 0 
= baca — dili i x 0acz x 0 
i 03 la 
gc2C3 — di 5203 eE Laözc3 
+ —gc283 + d1s283 — L30283 
gs2 + dicz — L303 
0 -Öz Özcz = 000383 [ 0 ] 
= UA 0 -= [dass + 620305] 0 
a [özcs - 620350] 0253 + 000303 0 la ] 
0 —03 0203 0 =; 0203 0 ] 
0 


i | be a ía ] E A ia | | l3 | 


| YgC2C3 — dı S2C3 + La0ac3 
+ -gc283 + dis2s3 — Lg02s3 
| gs2 + dcz — L302 | 


la0ac3 — l3020383 0 —b3 Ó2c3 l302c3 
= —l30253 — l3020303 | + 03 O  —02s3 —l30253 
0 —0a303 283 0 0 


gescz — dsac3 + Labacz 
+ -9c2s3 + dis2s3 — Labas3 
gs2 + dio — L302 
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la0acs l3020353 la0203583 Y9C2C3 — disoc3 + Lgacs 
—la0283 a la000303 + la0203c3 + —(C283 + d, S283 — Lað, 83 
L 0 | | 1303 | | gs2 + dicz — L303 | 
gc2c3 — dis203 + [Lg + l3] 02c3 
= — 90283 + d1 8283 — [Lg + ls] 0283 
982 + dicz — [L3 + la] 03 


mM39c203 — Mad, 8203 + M3 [L3 + l; 3] 6203 
F$ =mM3V¿b, = | —m3gczs3 + mad) s283 — My [L3 + la] 0253 
m3982 + mzdıc2 — m3 [L3 + l: ,]å2 


N = P'o tw? xE? 
To © ğ 0283 + Ó203c3 
= 0 Tis 0 Özc3 — 20353 
0 0 de Ës 
0253 I4 0 0 0253 
+ 0703 x 0 To 0 0203 
ds 0 0 IE, ds 
Ir. 0283 + [Iz — e + falaia 
= Ly, 0203 + us — I2,] 020383 


Í. „öz +[- =% + dl Boss 


Una vez que se ha concluido el enfoque externo, se aplica el enfoque interno. Se 
comienza con į = 3 para la articulación rotacional: 


mM39C2C3 — mad, 8203 + m3 [La + l3] Ëzc3 
f5 = Rife + F} = | —magczs3 + mad, s283 — ma [La + l3] 0253 
m3982 + mad, c2 — M3 [L3 + l3] 0 


n3 = N3 + Rèng + pe, xF3+pox Rofe 

Iz,ĝ283 + a, = Iva + Ls .1 020303 

— Iy,Ë2c3 + Los a Ls — za] 020353 
Ls, ¿03 af- [- Iz, + Iy] 025303 
| 0 ] M3agCaC3 — mad; $203 + M3 [L3 + l3] 0203 | kı ] 
> 0 x —M39C983 + mad, $283 =- my [Ls + l3] 0253 = ko 

| l3 ] | m39s2 + madıcz — my [Lg + l3] 02 ] | k3 ] 
kı = —mal3d,8283 + Es + m3 [L3 + l3] la] Üzs3 + s mi Ena + 53) 070303 + magl30283 
ka = —mglzd,s2c3 + [Iy + m3 [L3 + l3] l3] 0203 + Mas — Iys — Laa) 0,0353 + magl3cacz 
Ka = 12.03 + [—Lz, + 1441035303 
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n = [n] z5 


Iz,03 + [—Iz, «+ Ly.]0%5303 


Ahora se emplea į = 2 para la articulación rotacional y se obtiene: 


f = RE+F 
M3gCaC3 — mad, S2C3 + M3 [L3 + l3] baca mM239YC2 — mad; $2 
= R? —M39C283 + Mad, s283 — Mz [Lg + lg] 0283 | + | —mogs2 — modıc2 
m39s2 + madcz — my [L3 + l3] 03 0 


— [ma + ma] dis> + my [L3 + l3] Ó, + [ma + mg] gez 
= - [ma + m3) dic + m3 [Ly + la) 0 = [mo + ma) gs2 


0 
nå = N + Rn; +p, X F3 + p3 x Rif 
Na 
= n2b 
Nn2c 
nza = Mes — Iya] 025303 + 1.0203 — moglas2 — malad:co 
næ = —12,03 + [Lz, — 1y,)035303 — maglaca + malad1 82 
nz = -ms [Ls + l3] dis2 + [ia + Iyc3 + ms [La + la)" + da) öz 


+2 [Iz — Iy] 00038303 + m39 [L3 + l3] Ca 
T 
mT = [n] z3 
= —m; [L3 + l3] d,82 + [iss + Lich + m3 [L3 + la)? + A 0, 
+2 [as — vs) 07035303 + m39 [L3 = l3] Ca 
Finalmente, para ¿ = 1 con la articulación prismática se obtiene: 


RIA + F} 
| mg [L3 + l3] Ó2co — m3 [L3 + 13] 6352 + [mo + ma] g ] 


f 


0 
| [mo q+ ma] dı — m3 [L3 + la] 0259 — m3 [L3 + la] Oca ] 


En este caso, dado que la primera articulación es prismática, no es necesario calcular 
ni. Por lo tanto, el par requerido es: 


[3721 


[ma + m3) di — M3 [L3 + l3] 0282 — m3 [L3 T l3] 03ca 


T1 
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Empleando los resultados anteriores se obtienen las ecuaciones dinámicas del mani- 
pulador, las cuales se describen de la siguiente manera: 
q = [ma + my] di — m3 [Ly + l3] 0282 — M3 [L3 + l3] Oca 
To = -M3 [Lg + l3] dı So + p + LS + my [L3 + PA + 1,,] 0, 
+2 (Lx, - T] 02035303 + mag [Lz + l3] Ca 
T3 = 12,03 + [—Lz, + Lia) 0s3cz 


Nótese que las ecuaciones anteriores pueden factorizarse de la siguiente manera: 


M(q)4+C(q,4)4+G(q) =P 


donde: 
ma + M3 -m3 [Ly + l3] Sa 0 ] 
M(q)= | —m3[L3+l3]s2 Iz383 + 1,0 + ma [La + la)? +I, 0 
L 0 0 La, | 
0 -m3 [L3 + l3] 0202 0 
G (q, å) = 0 [i — del 038303 EER o Lys] 028303 
0 [-1Lz, + Lua] 028303 0 
dı 0 T1 
q= | 0 |,G(q)=| mag[Ls +l] | T=] 7 
02 0 T3 


y la matriz C (q, q) se denomina matriz de fuerzas centrífugas y de Coriolis. Además, 
nótese que: 


, 0 —my [Zs + l3]ĝzc2 0 
M = | —m3 [L3 f la] baca 2 Mo — val 035303 0 | 
0 0 0 
0 ma [L3 + la] Å2c2 0 
M -2C = | —mgy [L3 + l3] Ó2co 0 -2[17., — Iy] 023303 | 
0 2 os = Tys] 025303 0 


y puede verificarse fácilmente que la matriz M — 2C es antisimétrica. 


Como se mencionó anteriormente, la descripción del comportamiento de un sistema 
se obtiene empleando las ecuaciones dinámicas. Una posibilidad de obtener dichas 
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ecuaciones es empleando la metodología de Newton-Euler estudiada en la Sección 
anterior. Ahora se verá un método alternativo empleando las denominadas ecuaciones 
de Euler-Lagrange (EL). 


Las ecuaciones EL son útiles porque incluyen de manera implícita las relaciones de 
restricción, dado que emplean las denominadas coordenadas generalizadas, las cuales 
se relacionan con los grados de libertad del sistema, así como con sus restricciones. 


Se analizará que las ecuaciones EL describen el comportamiento de un sistema 
sujeto a restricciones holonómicas, y que dichas ecuaciones se obtienen empleando 
la función denominada Lagrangiano, que consiste en la diferencia entre la Energía 
Cinética y la Energía Potencial del sistema. La aplicación principal de las ecua- 
ciones EL será para obtener las ecuaciones dinámicas de los robots manipuladores. 


A continuación se presentará el concepto de las coordenadas generalizadas, de 
las restricciones holonómicas y la forma en que se deducen las ecuaciones de Euler- 
Lagrange empleando el Principio del Trabajo Virtual y el Principio de D'Alembert. 
También se mostrará la aplicación de las ecuaciones de Euler-Lagrange en algunos sis- 
temas mecánicos. Posteriormente se mostrará cómo extender los resultados obtenidos 
para ser aplicados a robots manipuladores. 


5.4.1 Restricciones y coordenadas generalizadas 


Sea un sistema arbitrario C compuesto por m partículas, las cuales se describen 
por medio de los vectores de posición ry,..., Im. Si todas las partículas se mueven 
libremente en el espacio, el sistema tendrá 3m grados de libertad. Sin embargo, cuando 
el movimiento de las partículas se restringe de alguna forma, los grados de libertad 
del sistema se verán reducidos de acuerdo al número de restricciones que existan. 


Un ejemplo de restricciones de movimiento se presenta en un péndulo simple. El 
movimiento del péndulo se da en un plano y la longitud del péndulo es constante. Si 
la posición del extremo del péndulo se describe por medio de las coordenadas [x, y], 
entonces el sistema debe presentar las siguiente restricción: 


x? (t)+y° (t) = l? = constante 


donde l es la longitud del péndulo. 


Las restricciones limitan el movimiento de un sistema, por lo cual reducen sus 
grados de libertad. En general, las restricciones pueden expresarse de varias maneras. 
Un caso especial se presenta cuando las restricciones se expresan empleando una 
relación con la siguiente estructura: 


f(t,r1,r2,..) =0 (5.26) 


Las restricciones que se expresan como en (5.26) se denominan holonómicas. Un ejem- 
plo sencillo se presenta considerando un sistema constituido por dos partículas, las 
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cuales se encuentran unidas por un cable rígido sin masa de longitud l. Considerando 
las condiciones anteriores, el sistema tiene la siguiente restricción: 


f(t,r1,r2) = (rı — r2)” (rı - r2) - l? = 0 (5.27) 


la cual es una restricción holonómica. 


Las restricciones que no se pueden expresar de la forma (5.26) se denominan no 
holonómicas. Por ejemplo, si se tiene un sistema que se mueve sobre la superficie 
de una esfera de radio r o afuera de la misma, y se describe la posición del sistema 
por medio de r, entonces en todo momento se presenta la siguiente restricción de 
movimiento: 

kier 


la cual no es de la forma (5.26) y, por lo tanto, no es holonómica. 


En algunos casos las ecuaciones de restricción puedan parecer no holonómicas. 
Sin embargo, éstas ecuaciones pueden ser integradas para obtener una restricción 
holonómica. Como ejemplo, sea la restricción: 


ar+8=0 


La restricción anterior parece no holonómica, ya que no tiene la estructura (5.26), 
debido a la presencia de la derivada t. Sin embargo, si existe una función g (t,x) tal 
que: 


La 09 B= 09 
Jr ðt 
entonces: ə ə 
IO 


lo cual implica que dicha expresión puede integrarse para obtener una restricción 
holonómica: 


$ (tx) =9(t,3)-=0 
donde y es una constante. 


El problema de que un sistema presente restricciones es que las coordenadas que 
describen el sistema se encuentran relacionadas por medio de las ecuaciones de restric- 
ción. Además, si se aplican algunas fuerzas externas a cada partícula, las partículas 
no solo experimentan dichas fuerzas externas, sino también las fuerzas de restricción. 
En el ejemplo de las partículas conectadas por un cable rígido, al ejercer una fuerza 
sobre una partícula, ésta experimentará adicionalmente una fuerza ejercida por el 
cable rígido. 


Lo que se buscará ahora es una metodología que permita analizar el compor- 
tamiento de un sistema sin que se requiera el conocimiento explícito de las fuerzas de 
restricción. En el análisis que se desarrollará se empleará el concepto de independen- 
cia lineal. En específico, dado un conjunto de vectores v;,..., Vs, se dice que dichos 
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vectores son linealmente independientes si la expresión: 
s 
Pi Aivií=0,1¿E€R (5.28) 
i=l 


se cumple si y solo si å; = 0 para todo ż¿ = 1,2,...,s. Otro concepto muy importante 
que se empleará es el de coordenada generalizada, por lo que se presenta su definición 
a continuación, 


Coordenada Generalizada 


Las coordenadas generalizadas son un conjunto n de coorde- 


nadas qk, k = 1,2,...,n, linealmente independientes que, junto 
con las restricciones, permiten especificar unívocamente la con- 
figuración de un sistema de n grados de libertad. 


Para visualizar el concepto anterior, supóngase que se tiene un insecto que se mueve 
únicamente en la superficie de una esfera de radio r. En todo momento el movimiento 
del insecto presenta la siguiente restricción: 


a+ys2?—r=0, vt>0 


Un error común en éste ejemplo es pensar que, como el insecto se mueve en el espacio, 
su movimiento puede describirse por medio de coordenadas cartesianas x, y, 2, y que 
dichas coordenadas son las coordenadas generalizadas. Sin embargo, nótese que si se 
conocen los valores de posición zx, y, entonces puede calcularse el valor de z como: 


z=Łyr -r - y? 


es decir, se obtienen dos valores que describen la posición del insecto, por lo que 
la posición no se describe de manera unívoca. En este caso, lo que se concluye es 
que las coordenadas cartesianas no son un conjunto de coordenadas generalizadas, lo 
cual se debe a la presencia de la restricción. El sistema sin restricciones tiene p = 3 
grados de libertad, con un número m = 1 de restricciones, por lo que los grados de 
libertad del sistema restringido son n = pm = 2. De esta manera, el movimiento del 
insecto puede describirse empleando el conjunto de coordenadas cilíndricas q = (0, 2] 
o esféricas q = [0,6]. El vector q se denomina vector de coordenadas generalizadas. 


El punto importante ahora es que, una vez que se ha establecido un conjunto de 
coordenadas generalizadas, es posible expresar la posición x del sistema como: 


x = x (t, q) 
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es decir, la posición del sistema siempre puede expresarse en función de las coor- 
denadas generalizadas. Dichas coordenadas generalizadas se obtuvieron mediante un 
análisis en el que se tomó en cuenta a las restricciones, por lo que las restricciones se 
encuentran incluidas en forma implícita en la expresión de la posición del sistema. 


5.4.2 Principio del trabajo virtual 


Considerando un sistema C compuesto por m partículas, la posición r de la k-ésima 
partícula puede expresarse en función del vector de coordenadas generalizadas q de 
la siguiente forma: 


rk = r(t, q) 


Suponiendo que la partícula experimenta un movimiento infinitesimal fry, éste puede 
describirse como: 
Orx Or 
ôr = ——dt + ——— 04; 
t= o 2 gn 
y, si la posición de la partícula no depende explícitamente del tiempo, se obtiene la 
relación de desplazamiento: 


que recibe el nombre de desplazamiento virtual. 


Los desplazamientos virtuales Jr;.....ór,, deben ser consistentes con las restric- 
ciones del sistema. Por ejemplo, considérese de nuevo la restricción (5.27) y supóngase 
que las partículas representadas por rı, r se perturban hasta [r, + $r,] y [r2 + Óra], 
respectivamente. Entonces, para que las coordenadas perturbadas sigan satisfaciendo 
la restricción debe cumplirse que: 


[ri + Ór] — r2 — rə)” [ri + ÓÍr] — r2 — ór,] =P (5.29) 


Al expandir el término anterior se obtiene: 


[r, + Ór, — r2 — ra)” [[r, + ór,] — [r2 +6r2]] = Ê 
(fr, — r2] + [ór1 — ór2])* ([r1 — r2] + [ór1 — óra]) = Y 
fr, — ra]? [rı — r2) + 2 [r1 — r2) [ór, — ór2] + [ór, — ór2]* [ór1 — ôr) = 2 


Si se desprecian los términos cuadráticos y se satisface (5.27), se obtiene la siguiente 
relación: 


[ri am ra [ór _ ór2] =0 (5.30) 
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Se concluye que cualquier perturbación en la posición de las dos partículas debe de 
satisfacer la ecuación (5.30) para que las posiciones perturbadas sigan cumpliendo 
(5.27). 


Si un sistema C consta de m partículas y q € IR” es el vector de coordenadas 
generalizadas, entonces todos los desplazamientos virtuales se pueden describir de la 


siguiente manera: 
n 


Or; » 
ôr; = y gy dit = 1, s.. M (5.31) 
j=1 


donde las restricciones se encuentran incluídas de modo implícito en los desplazamien- 
tos infinitesimales ĝqı, ..., fqn, debido a que se usan las coordenadas generalizadas. 


Si el sistema bajo análisis se encuentra en equilibrio, la fuerza total F¡, correspon- 
diente a la ¿-ésima partícula r;, es cero y, por lo tanto, el trabajo realizado por cada 
conjunto de desplazamientos virtuales dr; es cero. De esta manera se concluye que: 

m 
S For, =0 (5.32) 


i=l 
Para el caso de las dos partículas que se encuentran conectadas por un cable rígido, 
la fuerza de restricción ejercida sobre la partícula 1 por el cable debe ser de la forma: 


fi = c[r; == r2] 


para alguna constante c. Como reacción, se ejerce una fuerza sobre la segunda partícu- 
la descrita mediante: 
r 
f3 = —c [rı — ra) 


por lo que el trabajo realizado por las fuerzas de restricción ff, f3 correspondientes al 


conjunto de desplazamientos virtuales ôr}, rə es: 
107 ôr, + pa]? Ór> c[r, — ro)" ôrı — c [rı — ro]? Óra 


c[r; so r2)” [ðr am dr] =0 


que es igual a cero de acuerdo a (5.30). 


De acuerdo al análisis anterior, la fuerza F; se compone por dos términos: (1) la 
fuerza f; que se aplica externamente; (2) y la fuerza fF debida a las restricciones. 


Si se supone que el trabajo total realizado por las fuerzas de restricción es cero, 
entonces |3] 


k 
S [fr]? dr; =0 (5.33) 


i=l 


y, al sustituir (5.33) en (5.32), se obtiene: 


k k 
S Fión = Y £7ór;=0 (5.34) 


i=l i=l 


Cinemática y Dinámica de Robots Manipuladores e Roger Miranda Colorado Alfaomega 


278 Capítulo 5. Dinámica del manipulador 


En la ecuación (5.34) no se incluyen las fuerzas de restricción, sino solo las fuerzas 
externas. Lo anterior se obtiene suponiendo que el trabajo realizado por las fuerzas 
externas correspondientes a cualquier conjunto de desplazamientos virtuales es igual 
a cero, a lo que se conoce como Principio del Trabajo Virtual (PTV) (1, 2]. Un 
caso particular es el de las dos partículas rı, r2 conectadas por un cable rígido, lo cual 
representa a las partículas que constituyen a un cuerpo rígido. Para aplicar el PTV 
debe garantizarse que (5.33) se cumpla. 


5.4.3 Principio de D'Alembert 


En el caso general, los sistemas no se encuentran en equilibrio sino en movimiento. 
Para tratar este aspecto, sea $, el momento correspondiente a la partícula ¿į del sistema 
C. Al introducir una fuerza ficticia adicional -ġ; que actúe sobre cada partícula, se 
tendrá como resultado que todo el sistema estará en equilibrio estático. A lo anterior 
se le conoce como Principio de D'Alembert. Bajo esta consideración, al sustituir en 


(5.32) a F; por [E — ġ;|, se obtiene: 


Wim > ET br; — F $ ór=0 (5.35) 


i=l i=l 
donde W5, representa el trabajo realizado correspondiente al conjunto de desplaza- 


mientos virtuales ór. 


Empleando coordenadas generalizadas, el primer término de (5.35) puede rees- 
cribirse de la siguiente manera: 


m m n 


Sor = Y) Y E E sq; - $ Q;ôq; (5.36) 
j j=l 


donde el término (2; se define como: 
zis 7 Or; 


y se denomina j—ésima fuerza generalizada, correspondiente a la coordenada qj. 


Es importante notar que la j-ésima fuerza generalizada Q; no necesariamente 
debe tener dimensiones de fuerza, y que la coordenada generalizada q, no necesaria- 
mente debe tener dimensiones de longitud. Sin embargo, el producto Q;jôq; debe tener 
siempre dimensiones de trabajo. 


Ahora se analizará el segundo término de (5.35). Dado el vector de posición r; que 
describe a la ¿-ésima partícula de C, el momento correspondiente a dicha partícula se 
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expresa como GQ, = m¡F;. Por lo tanto: 


E Y mitos, = y a E; > 


¿m1 j=1 


además: 


-Dfi [r 18 = h El] 


ce Or; 
X mi — 
iml 09, 


La derivada con respecto al tiempo del vector de posición r; es: 


Nótese que: 


A J-> = Pri hed e _ ðvi 
dt 09; 2 2q:ón a 09; qı i 09; 


[m1 
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(5.38) 


(5.39) 


(5.40) 


(5.41) 


(5.42) 


donde la última igualdad se obtiene empleando (5.40). Dado que È; = v;, al sustituir 


(5.41)-(5.42) en (5.39) se llega a la siguiente relación: 


amO. e E ad su) 

5 xy 5 2 li T 
mir; — = — MiV; — | — mivi — 

¿=1 09; i=1 dt 04; 09; 


Defínase la energía cinética T como: 


OT di rôVi 
ere E NaN ae 
09; 2 09; 
OT m rôVi 
a = MiVi aa 
04; 2 04; 
d ôT = d q Ovi 
dt då; = 2, di [miv ETA 
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Empleando las derivadas anteriores, se puede reescribir (5.43) como: 


S a a (5.45) 
j 


y al sustituir (5.45) en (5.38) se obtiene: 


ii ~ fadaðT ôT 
pT ôr; = Par j 5.46 
2 ý 2 dt ðq; 09; % iii 


j=1 


Ahora es posible combinar los resultados de las ecuaciones (5.46) y (5.36), con lo que 
se obtiene la siguiente expresión: 


=([d9T or 
X ' Snip E aN a a Y 5.4 
par E dd; ða; 0) q=0 (5.47) 


La importancia de la expresión (5.47) es que los desplazamientos virtuales ðq; son 
linealmente independientes, por lo que se concluye que cada coeficiente de dq, en 
(5.47) es cero, es decir: 


=> “ar =0Qpj=1,...,n (5.48) 


5.4,4 Ecuaciones de Euler-Lagrange 


Sea U(q) la función de energía potencial del sistema. Las fuerzas generalizadas Qj 
en general se deben a fuerzas externas no potenciales y a fuerzas debidas a campos 
potenciales. De esta manera, la fuerza generalizada Q; puede expresarse como: 


_9U (q) 


Qj i 0q; 


Sy Tj (5.49) 


donde el primer término del lado derecho de (5.49) corresponde a la fuerza genera- 
lizada debida a un campo potencial, mientras que el segundo término del lado derecho 
corresponde a una fuerza generalizada no potencial. 


Ahora defínase el Lagrangiano , L, del sistema como: 
L=T-U 


donde T es la energía cinética del sistema y U su energía potencial. Entonces, la 
ecuación (5.48) puede reescribirse de la siguiente forma: 


dóOL ƏL 


aa du 


= Tjj =1,...,N (5.50) 
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y las ecuaciones (5.50) se denominan Ecuaciones de Euler-Lagrange (EL). 


Cuando en el sistema que se analiza todas las fuerzas externas aplicadas al sistema 
son potenciales, se dice que el sistema es conservativo. En éste caso las ecuaciones 
EL se simplifican de la siguiente manera: 


dóL ƏL . 
Sa ==" 7 = 0, = | ARE, ` (5.51) 
dt 0d; 04; 

A continuación se muestran algunos ejemplos en los que se obtienen las ecuaciones 
dinámicas de diversos sistemas empleando las ecuaciones de EL. 


Sea un robot de 1 GDL como el mostrado en la figura 5.19. El eslabón del robot se 
encuentra acoplado al eje de un motor de corriente directa por medio de un conjunto 
de engranes. Suponiendo que el ángulo del eje del motor es 0,,, y el ángulo del eslabón 
es ĝe, la relación del engranaje es Om = rĝe, donde r es la tasa de engranaje. Obtener 
las ecuaciones dinámicas del sistema empleando las ecuaciones EL. 


Figura 5.19 Robot de 1 GDL con motor de corriente directa. 


Solución 


El robot posee un grado de libertad, por lo que se considera que su coordenada 
generalizada es q = ĝe. Nótese que también se pudo haber elegido como coordenada 
generalizada el ángulo del eje del motor ĝm. 


Con base en la relación de engranaje, se cumple que Ôm = 70,. De este modo, la 
energía cinética del sistema es: 


T= Ar + Se? = > [ri Jm + Je] 62 = 5 [r Jm + J,] 3? (5.52) 


1 
2 
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donde Jm representa la inercia del motor y Je la inercia del eslabón. Para determinar 
la energía potencial se considera la figura 5.20, en donde se observa que: 


U = mgh = mg |l — 1cos0,)] = mgl [1 — cos q] (5.53) 


donde m es la masa del eslabón y l la distancia del eje de la articulación al centro de 
masa del eslabón. 


me 


Figura 5.20 Cálculo de la energía potencial. 


Definiendo J = r?J,, + Je se obtiene el Lagrangiano del sistema: 
1 
L= 318 — mgl [1 — cos q] (5.54) 


Ahora se emplean las ecuaciones EL de la siguiente manera: 


s dé i 
OL Jå OL Jü OL 


— = Jå, =— = Jä, — = -mgl sin 
di Oun “o did 
por lo tanto, la ecuación dinámica del sistema es: 
Jä +mglsinq = T (5.55) 


La fuerza generalizada puede estar constituida por el par del motor u = Tm, reflejado 
en el eslabón, así como pares de amortiguamiento debidos a la fricción viscosa y de 
Coulomb. Por lo tanto, las fuerzas externas pueden escribirse como: 


T =u -— få- fesgn(q) (5.56) 


donde f = rfm + fı, siendo fm el coeficiente de fricción viscosa del motor, fı el 
coeficiente de fricción viscosa del eslabón, fe el coeficiente correspondiente a la fricción 
de Coulomb, y sgn(-) la función signo, definida como: 


1 si z>0 
sgn(x) = 0 si ==0 
-1 si z<0 
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Finalmente, la ecuación dinámica del robot de 1 GDL se expresa como: 


Jä+ få + fesgn(å) + mglsing = u 


Ejemplo 5.13 


En la figura 5.21 se muestra un péndulo simple con una masa m en su extremo. En 
el brazo del péndulo se ubica un resorte con constante de rigidez k. El resorte se 
encuentra acomodado de tal forma que sólo se mueve a lo largo del eje descrito por 
el brazo del péndulo. En equilibrio el resorte presenta una longitud lọ. Emplear las 
ecuaciones EL para obtener las ecuaciones dinámicas del sistema. 


Figura 5.21 Péndulo simple con resorte en su brazo. 


Solución 


Al analizar el problema, se observa que éste se puede describir empleando dos varia- 
bles: la longitud 1 del péndulo y el ángulo 0 que forma con respecto a la vertical. Por 
lo tanto, las coordenadas generalizadas del sistema son: 


La posición [x,y] de la masa del péndulo, expresada en coordenadas generalizadas, 
es: 


R 
l 


[l + lo] sin 8 = [q1 + lo] sin q2 
y = -— [l + lo] cos = — [qı A lo] cos q2 


Cinemática y Dinámica de Robots Manipuladores e Roger Miranda Colorado Alfaomega 


284 Capítulo 5. Dinámica del manipulador 


Derivando los elementos x,y con respecto al tiempo se obtiene: 
t = dı sin q2 + [q1 + lo] ġ2 cos q2 
y = — 1 cos q2 + [q1 + lo] de sin q2 

por lo que la energía cinética del sistema es: 


i ET. m. 2 Mre. 2 
T = -mv v= — |v = = |i +: 

> > Ivi? = F e? +] 

M ó 2 . NPN 2 

=- flá: sin q2 + [g1 + lo] da cos q2]” + [~ġ1 cos q2 + [q1 + lo] da sin q2] | 

mí. 2. 

z (4 + la +l] él 
Para obtener la expresión de energía potencial del sistema, nótese que ésta debe de 
contener dos elementos. El primer elemento se debe a la posición de la masa m y es 
simplemente: 


mgy = —mg [q + lo] cos q2 


El segundo término se debe a la energía almacenada por el resorte, la cual es kq? /2. 
Por lo tanto, la energía potencial del sistema es: 


k 
U (q) mgy + zü 


k 
my [qı + lo] cos q2 + zi 


Empleando la energía cinética y potencial se obtiene el Lagrangiano del sistema: 


L = T-U 
Moa m 


zta 


k 
[1 + lo]? d + mg [qı + lo] cos q2 — z% 


Para poder aplicar (5.50) se realizan los siguientes cálculos: 


OL sá 
a“. 
IA 
uo Mp 
OL 
5 = mig +lo] 43 + mgcosq2 — kq 
091 
OL ; 
ds = m| + lo]? q2 
d ðL d E 
a > O [qı + lo]? da + 2m [q1 + lo] drá 
OL 
a = —mglqm + lo]sin q2 
092 
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En el planteamiento del problema no se indica que exista alguna fuerza externa, por 
lo que 7; = 0, i = 1,2. Por lo tanto, las ecuaciones dinámicas del sistema son: 


más — m [q1 + lo] d -mgcosq+kq = 0 
m [qi + lo] de + 2m4142 + mgsinqg = 0 


Ejemplo 5.14 


En la figura 5.22 se muestra un oscilador traslacional con actuador rotacional conocido 
como TORA, por sus siglas en inglés. El sistema consiste en un carro de masa M 
conectado mediante un resorte lineal de rigidez k a una pared fija. El carro sólo tiene 
movimiento en una dimensión, paralelo al eje del resorte. Unida al carro se encuentra 
una masa de prueba m con momento de inercia /. La masa de prueba se ubica a una 
distancia l de su eje de rotación. Las fuerzas gravitacionales son nulas debido a que 
el movimiento se da en el eje horizontal. Se supone que se aplica de modo externo un 
par de control denotado por 7. Emplear las ecuaciones EL para obtener las ecuaciones 
dinámicas del sistema. 


Figura 5.22 Oscilador traslacional. 


Solución 


Al analizar el sistema, es claro que la descripción de su posición queda completamente 
determinada empleando la posición x del carro de masa M y el ángulo 0 o posición 
angular de la masa de prueba. Entonces, las coordenadas generalizadas del sistema 


=[2]-[5] 
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Se empleará la convención siguiente para el ángulo q2: la posición q2 = 0 es perpendi- 
cular al movimiento del carro y la posición q2 = 7/2 rad está alineada con la dirección 
positiva de q1. 


La posición de la masa de prueba se describe empleando £m, Ym, y sus valores se 
obtienen de la figura 5.22: 


Tm = T+lsin0= q, +1sinq 


-lcos0 = —l cos q2 


Ym 
y las derivadas con respecto al tiempo de la posición de la masa de prueba son: 


Im = dh T lz COS q2 


Úm ES lda sin q2 
por lo que el vector de velocidad lineal de la masa de prueba se expresa de la siguiente 


manera: 
| im | l di + lg2 cos q2 | 
Vm = n = M ñ 
Üm lg sin q2 


La energía cinética T puede dividirse en dos partes, la T, correspondiente al movimien- 
to traslacional y la T, correspondiente al movimiento rotacional. 


Empleando v,, se obtiene la energía cinética T,,,. es decir, la energía cinética 
correspondiente al movimiento traslacional de la masa de prueba: 


1 
mv, 


Tum 2 m 


z . T f E 
e | dí + lg2 cos q2 | | dí + lå cos q2 | 


M= lg sin q2 lg sin q2 


1 1 - 
¿ná + mld, dz cos q2 + ¿méd 


Ahora se considerará el movimiento rotacional. Se sabe que 7 es la inercia de la masa, 
mientras que la velocidad angular correspondiente es q2. Por lo tanto, la energía 


cinética Tm correspondiente al movimiento rotacional de la masa es: 


Lp: I 
Tum = 32 Ida = 31h 
lo cual implica que la energía cinética T,n correspondiente a la masa de prueba es: 


1 1 
Ti ¿má + mld 149 cos qa + 3 [mi? + 1] d 


El carro de masa M sólo tiene permitido el movimiento horizontal, por lo que su 
energía cinética Ty es: 


lps 
Tm = zM di 
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Empleando los valores anteriores se obtiene la energía cinética total del sistema: 
; 1 A menes aci 
T(q,4) = Tu + Tm = 3 [M + m] q] + mlgrga cos q2 + 3 [mé + 1] 63 
Para la energía potencial, nótese que el movimiento del carro se limita al eje hori- 


zontal, por lo que no se tiene efecto de la gravedad. Sin embargo, el resorte almacena 
energía potencial, la cual está dada por la siguiente expresión: 


1 
U(a) = ¿ha 
De esta manera, el Lagrangiano del sistema es: 


L(q.4) T(q,q) - U(q) 


1 1 1 
= 3 [M + m] di + mlåġrġz cos qu + A [mé + 1] 3 — Ha 


Para emplear las ecuaciones EL se realizan los siguientes cálculos: 


OL 
ar => [M T m] 41 + mlg cos q2 
04, 
d OL : 
5 = [M + m] ğı + mläz cos q2 — mlåž sin q2 
ðL 
=— = -kq 
09 
= = mlq, cos q2 + (mi? + 1] de 
Oda 
d OL 


ETA = ml, cos q2 + [m]? + I] da — mlgrdo sin q2 


OL je i 
a. = -mlg sin q2 


042 


Debido a que el par de control se aplica sobre la masa de prueba, se concluye que 
Qı = 0,Q) = 7. Por lo tanto, ecuaciones dinámicas del sistema son: 


[M + m) dí + mläz cos q2 — mlå3 sin q2 + kqi 
mläı cos qu + [mi? + I] de 


0 


7 


Como paso adicional, nótese que las ecuaciones dinámicas del sistema pueden 
factorizarse de la siguiente forma: 


M+m  micosq» di + —mld3 sin q2 + ka | _ (0 
mlcosqo ml? +I do 0 0 la 
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Defínanse las siguientes matrices y vectores: 


mlcosqy ml? +I 


so- [' e[t] 


Empleando las definiciones anteriores, las ecuaciones dinámicas del sistema pueden 
escribirse como: 


D (q) = M+m  mlcosqa | ¡e l e a | 


D (a)ä +C (q,4) 4 + G (q) = Pu 


5.4.5 Ecuaciones EL en robots manipuladores 


Ahora que se han obtenido las ecuaciones de EL, se mostrará la manera en que éstas 
pueden aplicarse para obtener las ecuaciones dinámicas de robots manipuladores. 


Considérese un robot de n GDL como el de la figura 5.23. Como el robot se 
compone de n eslabones o cuerpos rígidos, su energía cinética será igual a la suma de 
la energía cinética de cada uno de sus eslabones. 

En la Sección anterior se vió que las ecuaciones de EL pueden expresarse como: 

aor or ðU 
-aea a (5.57) 
dt ð ðq dq 


En general, la expresión de la energía cinética de un robot de n GDL puede 
escribirse de la siguiente manera: 


T(a,4) = Zå4"M (a)å 


donde M (q, 4) € IR”*” es la matriz de masa del sistema y q € IR” es el vector de 
coordenadas generalizadas. Empleando la fórmula de la energía cinética anterior es 
posible obtener: 


OT 

— = M Å 

Jä (a)å 
d ðT m sz 
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por lo tanto: 


dor or us ibi 
Ls e Mia A 
dida 0 Irma- 34 q 
arta 

1 
= Mú+M4-=- : 
2 TƏM » 
4 q A 


Defínase N (q. 4) como: 
A sy l 
N (4,4) = Må -3 | 
å 


Empleando los resultados anteriores, junto con las ecuaciones de EL, se concluye 
que las ecuaciones dinámicas de un robot manipulador de n GDL se pueden expresar 
como: 


M (a)ä + N (q, 4) + G (q) =T (5.58) 


Los términos M (q) ä. N (q, å) corresponden a las fuerzas inerciales, G (q) es el 
término de pares gravitacionales y P' corresponde a los pares externos aplicados al 
robot. 


Un aspecto importante de (5.58) es que, si se calcula la energía cinética del robot, 
entonces se puede obtener directamente el valor de la matriz de masa M(q), y por 
medio de ella se puede obtener N(q.q). Además, si la matriz de masa es constante, 
N (q.q) será cero. 


En la figura 5.23 se muestra la ubicación del centro de masa del ¿-ésimo eslabón, 
dada por p.,. Además, se muestra la velocidad lineal va, del centro de masa de dicho 
eslabón, y su velocidad angular w;, así como su vector de posición p.,. La energía 
cinética asociada a éste eslabón se denota por T;. Si se calculan las energías cinéticas 
de los n eslabones que constituyen al robot, se obtendrá la energía cinética total 
T(q.4q) del robot, cuya expresión será: 


caril 


¿UM (a)å (5.59) 


T(q,4) = YT. 
i=1 
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Figura 5.23 Cálculo de la energía cinética del ¿-ésimo eslabón de un robot de n GDL. 


Los eslabones del robot pueden experimentar movimientos tanto rotacionales co- 
mo traslacionales. Para el movimiento rotacional, la energía cinética Tą, del ¿-ésimo 
eslabón es: 1 

y 
To (q, 4) = zu; L,w 


donde w; es la velocidad angular del ¿—ésimo eslabón, e I., es su tensor de inercia 
calculado con respecto al sistema de referencia {C;} con origen en el centro de masa 
del eslabón. 


De igual manera, la energía cinética Ty, correspondiente al movimiento traslacional 
del ¿-ésimo eslabón se obtiene de la siguiente manera: 


1 pen 
Ty, (q, q) >» ¿Mive, Ve; 


donde m; es la masa del ¿-ésimo eslabón y ve, la velocidad lineal de su centro de 
masa. 


Empleando las expresiones de Ty, . T.,,, se concluye que la energía cinética T; corres- 
pondiente al ¿—ésimo eslabón puede expresarse de la siguiente forma: 


1 
Tilg,4) = Tet Tay = F [miv ve, — w Iawi] 


Sea q € IR” el vector de coordenadas generalizadas. Para obtener una relación que 
incluya las coordenadas generalizadas, se emplea la ecuación de T; anterior, junto con 
(5.59), y se obtiene: 


Tlah) = YT; 606 
i=l 
Ls l 
= 54M (aå 
1 n 
= 3 2, [miv] ve, + w, lawi] 
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En el análisis del Jacobiano se indicó que éste puede expresarse como: 


J,(q) | 
J(q) = ` 
(a) | J.(q) 
donde Jy es la parte del Jacobiano correspondiente al movimiento traslacional y J,, la 


parte correspondiente al movimiento rotacional. Por lo tanto, las velocidades angular 
y lineal del centro de masa del ¿-ésimo eslabón pueden expresarse como: 


Ve = dvd (5.61) 


Jad 


Wi 


En la ecuación (5.61) se observa que v., y w; dependen explícitamente de las 
coordenadas generalizadas q. 

Un punto importante en (5.61) es que los Jacobianos Jy,, Jw; se relacionan con la 
velocidad lineal y angular, respectivamente, del centro de masa del ¿-ésimo eslabón, 
y no son los mismos Jacobianos Jy, Jẹ que se calcularon en el Capítulo 4, asociados 
con el efector final. 


La estructura correspondiente de los Jacobianos J,,.J,,, es: 


Op. Op. Op. 
Ita) = [Ge Fe Feo 0] 
Jala) = [ 2, EZ? e €Zií O --- 0 ] 


donde p., es el vector de posición del centro de masa del i-ésimo eslabón. 


Empleando la relación (5.61), es posible reescribir (5.60) como se indica a conti- 
nuación: 


T(q.4) 


l.r ; . _1 _ Es T r 
31 M (q) 4 = 3 E [miv ve, + w; L,w;] 


1 a n 7 
= ¿Y (E (mJ Jy, + JT Y, J,,,) å 


i=1 
de donde se deduce que la matriz de masa del sistema se calcula por medio de la 
siguiente fórmula: 


M (q) = $ [mI], Ju, + I 1e Jo] (5.62) 
i=l 
De la expresión (5.62), puede concluirse que la matriz de masa del robot consiste en 
un tipo de escalamiento del Jacobiano del manipulador por las propiedades inerciales. 
En general, la matriz de masa del robot es simétrica y cumple con la propiedad de que 


x" M(q)x > 0 para cualquier vector x % 0, i.e., la matriz M (q) es positiva definida. 
Además, M (q) puede escribirse término a término de la siguiente forma: 
m1 :*: Min 
M (q) = | | cr» 


Mai = Man 
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donde m;i; es la inercia vista desde el ¿-ésimo eslabón, cuando los eslabones que le 
siguen se encuentran fijos. Además, en un péndulo simple, la inercia del brazo depende 
únicamente de su longitud y la distribución de su masa, pero no de la variable de la 
articulación, por lo que se concluye que el término Mnn siempre es constante. De esta 
manera, siempre se tiene la siguiente dependencia: 


Mii = Mii (qi+1; ..., qn) 


Los términos que se encuentran fuera de la diagonal principal de la matriz de masa 
indican los acoplamientos que existen entre los eslabones. Por ejemplo, Mij, i Æ j, 
representa el acoplamiento que existe entre la articulación j y la articulación i. 


Supóngase que se tiene un robot de 2 GDL. Empleando los resultados anteriores, 
las ecuaciones dinámicas del robot son de la forma: 


m d 
ESAS 
m21 M22 q2 na g2 T2 


El vector N (q, å) se puede expandir como se muestra a continuación: 


; .. 1| a à 
N (q4) = Má-5| arot, 
2| 4 5d 
dm ðm 
å? ðqı ðq: . 
A 5 ðm; 3m2 q 
ii mii Mai2 å ha 1 ðqı ðq 
Thoi Maz 2 En du 1 — 1 , 
q dmza è mz |q 
0q2 UTA 


Para simplificar los cálculos anteriores, sea mij = Omi;/0q;. Entonces. el término 
N (q. 4) se reescribe como: 


T| Mi Mi 


; ; å å 
üg w [8 $ ls 1 m2 M221 
Mor Maz 2 gr mi12 Mi22 4 
M212 M222 
T| Mi Mi 2 
m j 1| 9 a 
o 11 Mai2 $ mi21 M221 
mo Maz 2 y mi12 M122 á 


M122 M222 
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y equivalentemente: 


mi11 M2 
mai21 M221 


| 
mi12 M122 la 

| 

| 


A 


Fiii a mi11d1 + Mirzd2 Mizid1 + M12242 | 1 | 
maniqr + M21242 Maz141 + M22242 2 | 
| M122 M222 
| a | mi Ma21 
mi21 M221 
| | mai12 M122 
mi22 M222 


e | Mingi + Mirada Miziq1 + M12242 | 
mi41 + Mıi22¢2 Mazid1 + M22242 


£ 
OA 


Expandiendo términos en la expresión anterior se obtiene: 


Nía4) = Mingi + Mirodida + Mirgi + Miz243 | 
i mi2147 + Miz2d142 + Mari dida + M22243 
ar | mi1d1 + mMi2142 | | 
1 Mi2191 + M22142 
2 gr m11241 + Mi12242 
m12241 + M222ġ2 
So l migi + Mido + Mi21d142 + m12243 | 
mingi + Mio 4142 + Mar d1da + mMo2243 
_1 l mingi + 2mi214142 + Mazda | 
2 | mi1247 + 21224142 + M2243 


Ahora se agrupan los términos de N(q,G), separando los términos que incluyen 
los elementos ¿? y los que contienen productos de velocidades diġj. De esta manera 


se obtiene la siguiente expresión: 


1 1 P 
N (qå) = 5 [Mi + mn — m1) 5 [m122 + m122 — M221] $ 
f 3 [m21 + M211 — My 12) 3 [M222 + M222 — M222] d 
+ | m112 + M121 — Mi21 | [(d1 42] 
m2a12 + M221 — M122 


Ahora se emplearán los denominados Símbolos de Christoffel, que se definen 
de la siguiente manera: 


1 
bijk = 5 [Mijk + Mikj — Mai] (5.63) 


Empleando (5.63) es posible reescribir N (q, 4) como: 


n bini bi | l Gi | l 2b112 |.. 
N (q, = F 
(q, 4) | bar b222 el dd O | PP 
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Defínanse las matrices C'(q). B(q) de la siguiente manera: 


_ | buni bra _ | 2112 
S | b211 b222 | ati l 2b212 | 


entonces, se obtiene: 
n & p 
N (q, 4) = Cta) | į | + B (q) ġiġ2 


En la última expresión, el primer término del lado derecho corresponde a las fuerzas 
centrífugas y el segundo término corresponde a las fuerzas de Coriolis. Con base en 
este análisis, es posible extender los resultados previos para un robot de n GDL, en 
donde: 


bıı biz2 +- inn di 
cidg ban 02,22 iii bainn "a 
a Bupi Dann i 
| 2b112 2b113 ++- 2b1(n-1)n | | dida 
B (a) [44] = | de q i ri sa 
| da n.13 E oi | | P A ] 


n(n-—1) 


con C (q) € M"*"” y B(q) € M"*“7—. Empleando las matrices anteriores se con- 
cluye que, para un robot de n GDL, el término N(q.q) puede expresarse como: 


N (a. åd) = Cla)a? + Bla) [ad] 


El siguiente paso consiste en obtener una expresión para el cálculo de la energía 
potencial. Para ello considérese el ¿-ésimo eslabón del robot manipulador de n GDL 
mostrado en la figura 5.23, en donde se muestra el vector pe, que ubica el centro de 
masa del eslabón de masa mj;. así como la altura h; del centro de masa del eslabón 
con respecto a la base del robot. Adicionalmente se muestra el vector de gravedad g. 
Entonces, se concluye que la energía potencial U;(q) del ¿-ésimo eslabón es: 


Ui (q) = mighi = mi [-g* Pa] 


donde el signo menos se debe a la dirección de g. 


La energía potencial total U (q) es la suma de la energía potencial de todos los 
eslabones, es decir: 


U (q) = YU, (q) 
i=l 
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Los pares gravitacionales G(q) que afectan al robot se obtienen al calcular la 
derivada parcial de la energía potencial con respecto al vector de coordenadas gene- 
ralizadas. es decir: 


_0U(q)_ : _TOPe, 
G (q) = ðq = 2, [ms a] 


Nuevamente, del análisis del Jacobiano se tiene la relación Jy, = Pe; /ðqi. Por lo 
tanto, el vector de pares gravitacionales puede expresarse como: 


E] 


mag 
GQY=- [E J e JE l 


“Vn 


(5.64) 
Mng 
De modo alternativo, la expresión (5.64) puede obtenerse recordando que T = 


JT (q)F. Las fuerzas que actúan sobre los eslabones son f; = —m;g. Por lo tanto, al 
sumar todos los pares de los eslabones se obtiene: 


= (Y, [mig] F Fes [m28] y Fo [mng] 


mıg 
m28 


G (q) 


e [E E e Y 


Con el análisis que se ha realizado, es posible calcular la energía cinética y potencial 
de un robot manipulador de n GDL empleando el análisis de cinemática directa, así 
como los cálculos del Jacobiano. Una vez que se conoce T(q,q).U(q), se calcula el 
Lagrangiano del sistema y se obtienen las ecuaciones dinámicas. 


Alternativamente, puede usarse el análisis cinemático y el cálculo del Jacobiano 
para obtener M (q) y, a partir de ésta matriz, calcular N (q, q). Luego se puede calcular 
G(q). y de esta manera se obtienen las ecuaciones dinámicas del robot manipulador. 


Es importante notar que en la parte traslacional de la energía cinética se tiene 
el producto vo, va, = live, ||?, es decir, se trata de la norma al cuadrado del vector 
vc, la cual es siempre la misma independientemente del sistema de referencia en el 
cual se exprese el vector. Por lo tanto, puede emplearse el sistema de referencia (0), 
calcularse Pc, , luego obtener I. y, entonces, obtener la energía cinética T; del i-ésimo 
eslabón. 


Para la parte rotacional de la energía cinética, el producto wT Iw es un escalar. Por 
lo tanto, su valor es el mismo sin importar el sistema de referencia empleado. Para el 
i—ésimo eslabón, puede calcularse su tensor de inercia con respecto a un sistema de 
referencia {C;}, paralelo al sistema de referencia {i}, con origen en el centro de masa 
del eslabón ¿. Entonces se obtiene el tensor de inercia o Lo anterior se hace debido 
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a que, usando el sistema de referencia {C;}, es posible obtener un tensor de inercia 
con estructura diagonal. 


Al elegir el sistema de referencia {C;}, los vectores de velocidad angular w? pueden 


A A i T : 
transformarse a {C;} empleando la matriz de rotación R) = [R}] , ya que los sistemas 
de referencia {i} e {C;} son paralelos. 


En resumen, para calcular las ecuaciones dinámicas de un robot manipulador de 
n GDL se pueden seguir dos caminos: 


1 Calcular los elementos de la ecuación general de la dinámica de un robot ma- 
nipulador: 


M(q)4 + N(q,4) + G(q) =T 


empleando las fórmulas: 


n 


Mg) =D [mi (22172, + [19] "1 0] 


i=l 
o Op. 0pL op. | 
Jy, = Es za o 0 0 
Ja, = [42% 2 +++ &z 0 --- 0] 
mie ] 
0 
mg 
T T T 
a=- | [49,1% [9,17 + [39,17] 
mag’ 
N (q.4) = C(q)4? + B(q) [ad] 
bar b122 +- Dinn di 
.2 b211 ba 22 ee ba nn $ 
Cda =]| . 
baaa bn.22 a Dana qe 
2b112 2b113 ::: 21 (m-1n dida ] 
2b212 b213 ++- 2b3(n-1n dida 
Balaa S | | 
2bm.12 2bm,13 FDO 2n,(n—1)n dn—1)4n 


1 
Dijk = y [Mijk + Mir — Moral] 
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2 Calcular la energía cinética y potencial del sistema. Calcular el Lagrangiano y 
aplicar las ecuaciones de EL para obtener las ecuaciones dinámicas del mani- 
pulador, empleando: 


T(4,4) = 54 M(q)4=34 (E [ms [387 30, + [131100] å 


i=l 
U (q) = E U; (q) 


U; (q) = mighi = m; (-g* Pe;) 


A continuación se muestran algunos ejemplos en los que se aplican las ecuaciones 
obtenidas anteriormente para determinar las ecuaciones dinámicas de tres robots ma- 
nipuladores, así como de un péndulo invertido rotacional, el cual es un sistema sub- 
actuado. 


Ejemplo 5.15 


En la figura 5.24 se muestra un robot manipulador planar RR. Obtener las ecuaciones 
dinámicas del robot empleando las ecuaciones de EL. 


Figura 5.24 Robot manipulador planar de 2 GDL tipo RR. 


Solución 


Empleando la asignación de sistemas de referencia mostrada en la figura, se obtienen 
los parámetros DH del manipulador, como se indica en la tabla 5.3. 
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Tabla 5.3 Tabla de parámetros DH del robot manipulador RR. 


[+ || aia || ti || di || 0 | 
ılo io fo fé | 
2 po [z fo [fe | 
slo ff fo fo | 


Las coordenadas generalizadas del sistema son las variables de las articulaciones, 
5 5 E T 
es decir, el vector de coordenadas generalizadas es q = [ q Q ] = [ 0, 03 ] 
Empleando la tabla de parámetros, se obtiene las matrices de transformación ho- 
mogénea del robot: 


par —$1 0 0 E —$92 0 Lı ] f? 0 0 La | 
0 S1 C1 0-0 : a 52 Ca 0 0 v 0 1 0 0 
=l o tollo o i o po 001 0 
0 0 0 1 0 0 0 1 0 0 0 1 
| c2 —-$12 O Lic; | c&2 —=s12 0 Lici + Lacr2 | 
= |22 ca O Lis, =| E 0 Lisi + Los12 
a EE: 0 1 0 ad: ME: 0 1 0 
0 0 0 1 0 0 0 1 


Ahora se realiza el cálculo de los Jacobianos Jyo, y Jw, correspondientes a las 
velocidades lineal y angular, respectivamente. Para ello se requiere la ubicación de los 
centros de masa de los eslabones: 


la lec 
0 
Pci 0 0 lası 
HIJO k 
1 1 
| loz ] | Lic1 + le2c12 
Po = TO 0 a Lisi + le2812 
1 Li 0 0 
1 1 
con lo que se obtiene: 
—1.181 0 
) Pe Op... as 
Tios = E 0 | = l.1C1 0 
0 0 
ae g =Lisı — le2812 —le2812 
To, = l ge 3 E Lici +leocra  leacra 


0 0 
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donde la es la distancia del origen del sistema de referencia {1} al centro de masa del 
primer eslabón, mientras que l.2 es la distancia del origen del sistema de referencia 
(2) al centro de masa del segundo eslabón. Con estos cálculos se obtiene la energía 
cinética correspondiente al movimiento traslacional: 


e T i , 
1 | | —lc181 0 T —l.1581 0 Jl 
= 4 mi leci 0 lacı 0 å 
[o of | % o] 
az 
1 = Lisi — leos12 —le2812 —Lis1 — leas12 —le2312 
+ mai Lici+lecia  leacra Lici + legcia  le2cr2 
0 0 0 0 


Lt mi1?, + mL? + 2m2L1l¿902 + Mly mal, + Mm2Lile2c2 á 
mal?, + ma Lile2c2 mal?, 


Los tensores de inercia de cada uno de los eslabones tienen la siguiente estructura: 


a E o ll ps 
| 0 0 ka| i | ba. 


Ahora se calculan los Jacobianos J$, y J$, como se indica a continuación: 


0 0 0 0 

Jo, > [ z) 0 ] = [1900 Ed a [ z) Z3 ] =j0 0 

1.0 R 

por lo que: 

a a = DIFTU AO 0.0 
Jn =J, = [R] Ll, =|4 a 0 ool=|l00 
0 0 1 l Q 1 Q 
T C2 —8ı2 O 0 0 0 0 
JS = J2, = [R] J2 = | s2 cz 0 0 0|= 0 
0 0 1 f 1 Ll | 
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y la energía cinética correspondiente al movimiento rotacional es: 


1 
T, = TAAN 1, (09) + 33097 eo 
' ww 0 00 
= al 0 0 o Gy 0 0 
1.0 0 0 EA 1 0 
i | ô l Tia 0 0 0 0 
+34 0 0 0 Ip 0 o 0jijå 
| 1 1 0 0 I222 1 1 | 


Al combinar los resultados anteriores se obtiene la energía cinética total del sis- 
tema: 


La Tee 
e . 
= ¿4M(ajá 
donde: 
_ [MM 
Md = | mi2 M22 ] 
mai = mil + maLi + 2m>L1l.9Co + mal?, + Izz + Izz 


ma = mall, + maLil.2C + Lz.29 


Il 


maz mall, + Izz 


Empleando la figura 5.24, se concluye que g° = [0,—g.0]”, por lo que la energía 
potencial del sistema es: 


vda T 
U (a) = -mı [pa] 8” -mə [po] 8” 
LC] > 0 Lic + l.9C12 id 0 
= =mi las1 “g — ma Lisi + l.2812 Y 
0 0 0 0 


mygl.151 + m29 [Lis1 + le2812] 
Con la energía cinética y potencial se calcula el Lagrangiano del sistema: 


L(q.4) T(q,4) - U(q) 


1 3 PA 
¿mud + m129142 + 


1 > 
¿mad — [m,gl.1s1 + m2g [Lis1 + l.2512]] 
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En este ejemplo, las ecuaciones dinámicas se obtendrán empleando la siguiente 


fórmula: 
doL_0L 
dt 04; 0; 


= Ti 


donde: 
OL . r 
Fin = m1141 + M1242 
1 


d ƏL 3 e E R 
— = mnği + mid — [2m2Lile282] dido — [malile282] 43 


dt qı 
aa” —my9l.101 — m29 [Lici + le2c12] 
qı 
J; — m1241 + Ma2d2 
q2 

d ðL n4 a [maal ld 

—— =m m — |m (25 

di 0d 1241 2242 210.282] 4142 
OL : > E 
y —m2L1l.2s2 Gi — [m2Lile282] dido — maglezcr2 


Empleando los resultados de las derivadas anteriores se obtienen las ecuaciones 


dinámicas del robot como se indica a continuación: 


n = Midi + m2 — [2m2L1 1.252] dido — [ma2L11¿2 82] 43 
+m19l.101 + Mog [Lici + l¿2C12] 


r mA .2 
T = Mi2Q1 + Ma22) + maLil.9824; + magl.2012 


Nótese que las ecuaciones anteriores se pueden factorizar, para obtener las matrices 
C (q), B (q) y G (q) como se indica a continuación: 


o 0 —maL1l.9892 
C (q) — l maL1l.982 0 
2 L le < 
B (q) = | naa > 


n a 
29te2C12 
Las matrices anteriores también pueden obtenerse empleando los símbolos de 


Christoffel como se indica a continuación: 


_ | bui biz _ | 2112 
ca = | pe ne | Ba- | | 
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donde: 


bai = 0,b12 = —m2Lil¿282,b211 = m2L1l.282, b222 = 0 


bi = —=məLlile2s2, b212 = 0 


y se observa que, en ambos casos, se obtiene el mismo resultado. Finalmente, las 
ecuaciones dinámicas del robot son: 


-2 
Maä+ca | j | + B (9) dá + G (q) = | >: | 


Ejemplo 5.16 


En la figura 5.25 se muestra un robot manipulador de cuatro grados de libertad con 
configuración RPRP. Empleando la asignación indicada de los sistemas de referencia, 
centros de masa y longitudes, determinar las ecuaciones dinámicas del manipulador 
empleando las ecuaciones EL. 


0... 


Figura 5.25 Robot manipulador RPRP. 


Solución 


Primero se determina la cinemática directa del manipulador. Los parámetros DH del 
robot se muestran en la tabla 5.4. 


Alfaomega Cinemática y Dinámica de Robots Manipuladores e Roger Miranda Colorado 


5.4 Ecuaciones dinámicas de Euler-Lagrange 303 


Tabla 5.4 Parámetros DH del robot manipulador RPRP. 


Con los parámetros DH se obtienen las matrices de transformación homogénea del 
robot: 


a -s 0 0 1.0.0 o ] 
a 0.0 010 0 
A E a pi 
1 0 0 1 L | -T 0 0 1 da | 
0 0 0 1 ] 00 0 1] 


= O © 


O O m © 
o 

mu E 

o 
AAA 


| tc -si 0 0 CiC3 —C183 si 0 ] 
T® ` $81 C1 0 0 T? = 8103 3133 —Ci 0 
2 0 0 1 Lı + də e $3 C3 0 Lı + dy 
| 0 0 0 1 | | 0 0 0 1 | 
C1C3 $1 C183 c1s3da 
T’ = S13 —C1 $183 $183d, 
2 S3 0  —c3 Li+d2-— cada 
0 0 0 1 
Cil3 $1  C183 L5c¡83 + C1S3d4 
T? = $103 —C1 $183 L58183 + s1s3da 
a= 53 O  —c3 Li+ dz- Ls5c3 — cada 
0 0 0 1 | 


Ahora se ubican los centros de masa de los eslabones. Dichos centros de masa se 
representan en la figura 5.25 con la denominación (p.,. Pez, Pes: Pea}. Por lo tanto, 
los vectores correspondientes son: 


0 ¿po 0 
p=] 0 |+[2R9 "| o | = 0 
-Lı lh -Lı +h 
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1 1 Druk | li | 
1 J la] 
0 0 
Pe _ A p? 0 0 E 0 
l >| re | i E RRA 
1 1 
, | 0 | l4C183 ] 
| Da | > r| Ph | = TO =l "x l48183 
1 3 E 3 0 Lı + dy - l4c3 
1 1 
0 


| ] | cis3da + l5c183 ] 

| Pe a PE ]-19| 2 ¡alar | 
E E A T N 

| | i ' ? éii 5 | 


1 


Considerando que las cuatro articulaciones del robot son independientes, es claro 
que las coordenadas generalizadas q(t) del robot son: 


qı 0; 

q2 o dz 

a q3 03 
q4 d4 


Empleando las coordenadas generalizadas, los vectores que ubican los centros de 
masa de los eslabones se reescriben como se indica a continuación: 


0 
Pa =| 0 
lı 
0 
Po, = 0 = 
Lı+d2 -l2 et 
l4c183 l4C183 
p% = l4s183 = l48183 
Lı + da — l4c3 Li + q2 — lacz 
cis3da + l5c183 c183%4 + l5C1 83 
Po, == sis3da + l5s183 = si834 + l58183 
Lı + d2 — cada — l5c3 Lı + q2 — C3qa — l5c3 


Alfaomega Cinemática y Dinámica de Robots Manipuladores e Roger Miranda Colorado 


5.4 Ecuaciones dinámicas de Euler-Lagrange 305 


Empleando los vectores p.,. se calculan los Jacobianos relacionados con la veloci- 
dad lineal: 
| 0000 ] | 0000 ] 
K, =; 000 0j, =;0000 
| 0000 | | 0100 ] 


—145183 0 l4c103 0 
Jia = l4c1 83 0 145103 0 
l | 0 1 lsa 0 ] 


0 


| 818344 — l5sisg3 0 cic3qa + l5C1C3 0183 
Vos | 


cis3G4 + l5cisg 0 sic3q4 +l58103 8183 
0 1 s3Ga + l5s3 —C3 | 


Con los valores de los Jacobianos obtenidos anteriormente es posible obtener la 
energía cinética Ty correspondiente al movimiento lineal de los eslabones como se 
indica a continuación: 


T = ar [im [R] R, mier, 
T T 
+m3 Ea 1 Joo, + ma [yo] ca å 
= rT, 14 
2 
donde: 
| Mia 0 0 0 ] 
MÁS: 5 0 Ma + Mz + Ma Mgalas3 + Ma (9483 + l553) —Ma4Cz 
| 0 malas3 + ma (s3q4 + l583) mal + ma (qa + l5) 0 | 
0 —mMa4C3 0 ma 
Mim = mals? +ma (ls + q4)? sí 


Los tensores de inercia de cada uno de los eslabones son: 


| Les 0 0 | Tez 0 0 ] 

7 = | > Iyi h pes] : Iy Ea | 
z221 222 
Tea? 0 iso 0 0 

I = | j lys k; [e-l j Iys k; | 
zzí z24 


Ahora se determinan los Jacobianos relacionados con el movimiento rotacional, 
como se indica a continuación: 


0000 
alr 00 0]=|00 0 0 
10.00 
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[o0 0 0] 
Z =[2 0 0 0] 0000 
lio00] 
0 0 $1 0 
Pp =[XH 0 23 0]=]|0 0 -a 0 
ioo o0 


[foa 0] 
"li e a a 


Ahora se deben transformar los Jacobianos anteriores para representarlos en el 
sistema de referencia ubicado en el centro de masa de cada uno de los eslabones. Se 
considera que el sistema de referencia ubicado en el centro de masa de cada uno de 
los eslabones tiene la misma orientación que el sistema de referencia correspondiente 
empleado para la cinemática directa, por lo tanto: 


P 0000 
JO me Jl = [R] =|0000 
1000 

m 0000 

Hazas [RI 0 0 0 
0.0.0 

$3 0 0 0 

JA Je =[R0]* Taal =.| e. 00 0 
0010 


T | s 0.00 
J =J =[R] Z, =]; 0 0.1 0 
[a 0 0 o ] 


Con los cálculos anteriores es posible determinar la energía cinética Tą relacionada 
con el movimiento rotacional: 


1 
To METE + METI 
+ [10]7 A [72] sao la 
4 Wa 
La + Izz2 E T S > cilu P Las «> ls 0 0 0 
o l.r 0 0 0 0 
A y 0 0 hatha |" 
0 0 0 0 
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Ahora se calcula la energía cinética total T(q, q) del robot: 


Tlga = K+T; 
la z 
= 54M (a)å 
donde: 
| mai 0 0 0 
: o 0 ma Mo  —MaCz 
M (q)= 0 m32 m33 0 
0 —Ma4Cz3 0 Ma 
: 2 
m1 = mal? s? + Ma [ls + qa] s? + Ir 
Ir = lia +liz + + a E BI yy3 + Less + loza 
Moa = M2 + mM3z + Ma 
m32 = Mal¿s3 + ma [8394 + l5s3) 
mə3 = Mglys3 + ma [q453 + 553] 


mal? + Ma [qa + 15)? -$ l223 + Tay 


m33 


De acuerdo a la figura 5.25, el vector de gravedad es g° = [0,0,—g]". Por lo tanto, 
la energía potencial del robot es: 


U(q) = -mı [p?,]" g? - ma [p2.]? g? — ma [p?,]" g? — ma [p?]" gl 


limig + m2[L1 + q2 — la] g + mz [L1 + q2 — luca] g 


+ma [Lı + q2 — c3q4 — l5c3] g 


Empleando los valores calculados de la energía cinética y potencial, se procede a 
determinar el Lagrangiano del sistema: 


L(q. 4) T(q,4) - U(q) 


= 3 [midi + mo243 + m3343 E m44 + 2m23ġ2ġ3 + 2m24424a] 


— [Img + mə [Li + q2 — lo] g + m3 [Li + q2 — luca] g 
+ma (Li + q2 — c394 — l5c3] 9) 
Las ecuaciones dinámicas se obtienen empleando las ecuaciones EL: 


dOL ƏL 


dð dq ' 
por lo que se requiere de los siguientes cálculos: 
57 = Mud 


0% 
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2 
mıı = malís2 + ma (l; ef- qa) s3 tip 


: ] 2 s y 
11 = 2m3l 530343 + 2ma (ls + q4)” s3c3ġ3 + 2ma (ls + q4) sida 


d ðL + rá 
apis m m 
di dá 1191 1149 
.. e o 2 . o 
= miQq + 2m3ls3c34143 + 2m4 [ls + q4] 83034143 
+2ma [ls + q4] sid1da 
L : ¿ i 
a = M2202 + M2343 + M2444 
Oda 
Maz = Ma + M3 + Ma 
mo = 0 
maz = Malas3 + Ma (qus3 + l5s3) 
mo =  [malacz + ma [c3q4 + l5c3]] da + mas3da 
M24 = —MaC3 
T24 = M48343 
d ðL i e A LOPTE oo. ¡A 
AT = Mad + M2343 + Masa + Mao a + M2343 + Masa 
dt Oda 
= Maza + Mağz + Mora 
+ [malacz + ma [c3q4 + l5c3]] di + 2m4s3d3da 
L ] ] 
37 = M3343 + M2342 
043 
2 
m33 = mal + Ma (qa + ls) + Izz3 + Iuyt 
m33 = 2m4 (qa + l5) da 
d OL n n OR Eaa 
TE M3343 + MazQ2 + Mazda + Mazda 
dt 043 


= Mazda + Mazda + [malaca + ma [c3q4 + l5c3]] de da 


+mas3dada + 2m4 [qa + ls] dada 


OL . i 
o. = Masa + M2442 
q4 
Mas = Ma 
Mas =0 
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d OL . o A OS 
A Masa + M24Q2 + Masqa + Moa o 
dt Oda 

= mağa + Mağz + [mas3g3] de 


= Maasda + Maada + Mas3d2d3 


OL 
—=0 
0% 
OL 
042 


mıı = malisi + ma [ls + q4}? 83 + Ir 


= — [m2 + m3 + ma] g 


ðm 

vaL 2m3l?s3c3 + 2ma4 [ls + qal? S3C3 

043 
maz = Mmala4s3 + Ma [qa83 + l5s3) 


dmz 
093 


= [mala + q4 + l5] 03 


May = -M403 
mos 
043 


= Mas3 


ðL 1 ðm .2 + ¿9m2s rá ön 


e V 
= ——( —— 943 + aTa aa] — [mal4s39 + Mas3G49 + Mals 839 
043 2 | 3q ™ ` 09 043 


[mslisgcs + ma [l5 + qal? sca] di + [mala + qa + ls] c3] dad + [masa] ġ2ġ4 
— [myl¿539 + Mas3949 + Mal5839) 
mu = mals} + ma [ls + q4]? s3 + Ir 


ðmıı 
094 


m33 = mal + ma [qu + 15)? + Lzz3 + Iyya 


= 2m4 [ls +- qa] si 


Imaz 
044 


maz = Malas + ma [qas3 + l5s3) 


= 2mMa4 [qa + l5] 


ðL 1 ðmıı .2 dma33 .2 ðmə3 ás | 
Satt == —— 3 + 2 mac: 
Oda 2 | qı f 044 43 01 (243 A 4039 


= Ma [ls + qa] sii + ma [q4 + l5] di + Mas3d2d3 + M4C3g 
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Empleando los cálculos anteriores se obtienen las ecuaciones dinámicas del robot: 


TT = mMmunuğı + [2mslisgcs + 2ma [ls + qa] 5305] diás + 2m4 [ls + qa] sidida 
Ta = Maza + Mazda + Marga + [malacz + ma [c394 + l5c3]] 43 
+2ma4s3d344 + [ma + ma + ma] g 
T3 = Mazda» + Mazda + [ma [c3q4 + lsca)] — [qa + l5] c3) dada + 2ma [qa + l5) dada 


- [mliscs + ma (ls + q4]? sses] di + malas3g + mas3q49 + malss39g 


Ta = mağz+ Marga — Ma [ls + q4] s34? — ma [qa + 15] 43 — macag 


Las ecuaciones anteriores pueden factorizarse empleando las siguientes matrices: 


[ ma 0 0 0 


Z O ma mə; Ma 
M (a) o | 0 Moz M33 0 | 


0 ma 0 my 


0 0 0 0 
0 0 mal¿C3 + Ma [c394 + 1, c3) 0 
C (q) = 2 2 
- [malisacs + Ma [ls + qa] sse] 0 0 0 
—ma (ls + q4] s3 0 —ma [qa + l5) 0 | 


0 b2 bg 0 O 0 ] 
0 0 0 0 0 bæ 
B@=|o o o Doa: 0 ibg 
0 0 0 0 0 0 
bi = 2m315303 + 2m4 [ls -$ ul $3C3 
big = 2m4 [ls + qa] s3 
b26 = 2m483 
b3a = ma [c3q4 + l5c3] — [q4 + l5] c3 
bzs = 2m4 [qa + l5] 
0 
B [ma + m3 + ma] g 
G (a) Ñ mal4s39 + mas3di9 + malss39 
—Mac39g 


con lo que se obtiene la siguiente forma simplificada de las ecuaciones dinámicas del 
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robot: 
dida ] 
di 4143 T1 
.. d3 dida T2 . 
ds pp e o | (5.65) 
43 q243 T3 
di dada T4 
dada 
Ejemplo 5.17 


Sea el robot manipulador RP mostrado en la figura 5.26. En la figura se indica la 
ubicación de los centros de masa C1, C2 correspondientes a los eslabones 1 y 2, 
respectivamente. Determinar las ecuaciones dinámicas empleando las ecuaciones EL 


[1]. 


Figura 5.26 Robot manipulador RP. 


Solución 


Es importante notar que en la figura se muestran dos distancias aparentemente iguales: 
də y l. Sin embargo, la distancia də es la que existe entre el centro de masa del segundo 
eslabón y el origen del sistema de referencia (0). Por lo tanto, al actuar la articulación 
prismática, la distancia dy será variable. Por otro lado, la distancia marcada como 
lə se refiere a la distancia que existe entre el origen del sistema de referencia (2) 
y el centro de masa del segundo eslabón, por lo cual dicha distancia siempre será 
constante, independientemente de que actúe la articulación prismática. 
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Otro aspecto importante es que, a diferencia de los análisis de cinemática directa 
anteriores, ahora se indica de modo específico el ángulo 0; tomando como referencia 
la configuración mostrada en la figura. De esta manera, el ángulo 0, marcado en la 
figura es el que existe entre Xy y Z2, medido con respecto a zı. Por definición, el ángulo 
01 debe ser el ángulo que existe entre los ejes xy y xı medido con respecto a zı. Por 
lo tanto, en este caso dicho ángulo es 0; + 90. Tomando en cuenta las consideraciones 
anteriores se obtienen los parámetros DH mostrados en la tabla 5.5. 


Tabla 5.5 Parámetros DH de manipulador RP. 


[i aa fas fa 4 
pio fo fo  [f0+s0| 
p2ff90 fo fd-e*ffo_ | 


Con los parámetros DH se obtienen las siguientes matrices de transformación del 
robot manipulador: 


le, -a 0 0 10 0 0 

0 ĉi «$7 0 0 Ys 0 0 -1 —də + lo 

2 0 0 1.0 i ig E E 0 
0 0 0 3 0 0 0 1 
—$1] 0 Cl cid = loc; 

T? = C1 0 $1 sida g las] 

.— 0. 10 0 
0 0 0 1 


Debido a que se tienen dos articulaciones independientes, las coordenadas gene- 


A continuación se obtendrá la matriz de masa del sistema. Para ello se emplearán 
los Jacobianos J}, y a ', donde (C;) es el sistema de referencia ubicado en el centro de 
masa del eslabón ¿, el cual se considera paralelo al sistema de referencia {i}. Entonces, 
la matriz de masa del sistema es: 

TA 017 yo 01T yo C117 1C: 7C: Ca]T 1C2 7C2 
M = m; [12] dy, + ma [3] Jus: + [154 Ido, + [JE] I5 A 

Las coordenadas de los centros de masa de los eslabones, calculados con respecto 

a su propio sistema de referencia son: 


0 0 
Ph =| - -ph =] 0 
0 l 
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Para transformar los vectores pe, al sistema de referencia (0) se emplean las 
matrices de transformación homogénea. De esta manera: 


$] 01 0 0 0 lici 
Ja] a -—si 0 EAS 
1 1 1 0 0 1 0 0 0 
| 0 0 0 1] | 1 | | 1 | 
| 81 0 & ciq2— la2ci 0 ] c142 
l Pa | e al Pi, | j] & 0 sı siq2—l2s1 || 0¡_]1 $ | 
1 +1 0 1 0 0 la 0 
La E FTE 


Con los datos anteriores se calculan los Jacobianos correspondientes al movimiento 
lineal, como se indica a continuación: 


yso -l5 0 

0 Po a 

A=[1%% 0]- ha o 
3142 Cı 

o _ [| 0p2, 0p2 E 

a E e 3 Dl e 


entonces se obtiene: 


T —l181 0 d =li sı 0 
mi [32 ] Fs = mi lic 0 lici 0 | 
0 0 0 


T 
0177 yo | -AN | | ATE ] 
ma [dia] Jy, = M2 Cia Sı ca 3) = 
| o. 0 ] | o. 0 ] 


Los jacobianos J„;,, correspondientes al movimiento rotacional, se calculan de la 
siguiente manera: 


0 0 0 0 
Z =[2 0]=|0 0/,% =[z2 0]=|0 0 
1 0 1 0 


y, empleando las matrices de rotación Re, = Ry Re, = RJ, se obtienen los siguientes 
resultados: 


n sa e AER 0 0 
JẸ =J} = [R] V=] a -s 0 E e gm O a 
0 0 1 1.0 1 0 
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r [ -s 0 a] fo o] po 0] 
== [R] Z=] a 08 00j=]|1 0 
Lo 10o] lio] loo] 
Se supone que los tensores de inercia se calculan considerando sistemas de re- 
ferencia ubicados en los centros de masa de los eslabones, y que dichos sistemas de 


referencia {C;} se eligen con ejes coincidentes con los ejes principales de inercia. Por 
lo tanto los tensores de inercia tienen la siguiente estructura: 


sza 0 0 Irz2 0 0 
Iç aa 0 Iyy,1 0 ns = 0 Lyy,2 0 
0 0 Leza 0 0 Laa 
y al combinar los resultados anteriores se obtiene: 
T 0 0 d Izz. 0 0 DO I 0 
per Ig =|0 0 0 Sui 0 e l sa 0 | 
10 0 0 Izz 1 0 
T 
T 0 0 i 0 0 0 0 I 0 
[75] LEA =|1 0 0 L>9.2 0 i Mob | ne p | 
0 0 0 0 Lz2.2 0 0 


Con los cálculos anteriores es posible obtener la matriz de masa del sistema de la 
siguiente manera: 


M= m2] +m [RI + [12] "1332 + [12] "1332 


1 2 


mil 0 4 maq3 0 + az 1D + Ira 0 

0 0 0 ma 0 0 0 0 
mL + mod + Liza +lyy2 0 
0 ma 


De la estructura de la matriz de masa puede observarse que la contribución de la 
masa m, aparece en el término m, [J2 ] F A aA Además, los términos fuera de la diago- 
nal principal son nulos. En dichos casos se dice que el robot se encuentra desacoplado. 
Como era de esperarse, el término m22 es constante y representa las propiedades iner- 
ciales a lo largo del eje 2, i.e., si se fijara la articulación 1, esencialmente se tiene 
únicamente un movimiento de la masa ma, lo cual se aprecia en el término m22. Por 
otro lado, si se fija la articulación 2, al rotar la articulación 1 se percibe la inercia 
de los dos eslabones, y el efecto del producto de sus masas por el cuadrado de las 
distancias al centro de masa de las dos articulaciones. 


Para determinar los términos correspondientes a las fuerzas centrífugas y de Co- 
riolis, primero se calculan los símbolos de Cristoftel. El resultado de dicho cálculo se 
muestra a continuación: 


bi = 0,bi2 = m2q2,b121 = m2q2,b122 = 0 
bam —m242,b212 = 0, b221 = 0, b222 = 0 
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Empleando los símbolos de Christoffel, se obtienen las matrices C'(q), B(q) como 


se muestra a continuación: 
| biii bi22 | ne | 0 0 | 
b211 b222 -m2əq2 0 
2b112 | _ | 2m2q2 
y, por lo tanto, el término correspondiente a las fuerzas centrífugas y de Coriolis es: 
0 0? 2m>42 > o 
La —mM242 o | [3 il | 0 aii 


di 2m>242 | ue 
9 ie 
le —M292 4 | d ] Ey 


Ahora se calcula el vector de pares gravitacionales: 


C (q) 


B (q) 


N (4,4) 


Ga) = - [[12,1% mg" + [9,1% m2g"] 


donde g° = [0, —g. oy, por lo que: 
0 0 
=lisi he 0 A -q281 Qe 0 k 
-im | 0 0 0 E + ma ps a Ú g 
an | -myglyc; |] -f —1M2942C1 | 
0 —m2981 


ger [mili + maqa] 
ma98S1 


G(q) 


Ahora ya se cuenta con todos los términos requeridos, por lo que las ecuaciones 
dinámicas del robot PR son: 


Em + magh + Izzi + Iy 0 ä 0 0 q? 
0 Tr 0 4 
2məq2 |.. ger Ea = PSN 
+ l 0 [ús P l m2981 


Con las ecuaciones dinámicas anteriores es posible diseñar estrategias de control 
para el robot RP. i 7 


Ejemplo 5.18 


En la figura 5.27 se muestra un péndulo invertido rotacional, también conocido como 
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péndulo de Furuta. El sistema consiste en un brazo horizontal que rota y tiene acopla- 
do un brazo o péndulo, el cual se debe de equilibrar en su posición vertical. El sistema 
cuenta con un actuador en el brazo horizontal, pero no existe ningún actuador en el 
péndulo. Debido a lo anterior, el sistema tiene dos grados de libertad, aunque sólo una 
entrada de control. Dichos sistemas se denominan sistemas subactuados. Emplear las 
ecuaciones de EL para obtener las ecuaciones dinámicas del sistema, tomando como 
sistema de referencia base a {h}. 


Figura 5.27 Péndulo invertido rotacional o péndulo de Furuta. 


Solución 


En la base del péndulo se encuentra una articulación rotacional, cuya variable de 
articulación se representa por 0,. La longitud del péndulo es lp, la longitud del brazo 
horizontal es la, y la posición angular del péndulo se describe por medio de la variable 
02. Debido a lo anterior, el sistema cuenta con dos grados de libertad y el vector de 
coordenadas generalizadas correspondiente es q = [q1.q2]” = [01,02]". Empleando la 
asignación de sistemas de referencia mostrada en la figura se obtienen los parámetros 
DH como se indica en la tabla 5.6. 


Tabla 5.6 Parámetros DH del péndulo invertido rotacional. 


li || os || ai-ı || d: fo | 
pio fo Hola | 
[2 I -9% po ff? [f[ -(0 +90) | 
lso la lolo | 
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Empleando la tabla de parámetros DH, se obtienen las matrices de transformación 
homogénea del sistema: 


|$ 5 UN es ca 0 0 1005 
ën par a 0.0 ot TRA Es 1.0.0 
co 0 0. 1.0 Ly co s 0 0 »T3 = 0 0 1 0 
0 0 Q 1l 0 0 0 1 0 00 1 

—C19 C1ıC2 —$S1 —1 451 —=C182 Cil9 —$S1] —l 451 a 1,0182 

TO = 8182 5SiC2 Cl lacı T? = —8182 $SiC2 Cl lacı — lp8182 
C2 82 0 0 e Ca 82 0 lpCa 
0 0 0 1 0 0 0 1 


Ahora se considera el sistema de referencia {h}, donde: 


0. 1.00 
i -1000 
Tò =Rote-3=| 9 010 
0001 


con lo que se obtiene finalmente la matriz de transformación: 


=S182 Sia C1 lacı — 1,8182 


h Ci S2 —C1C9 $ lası + 1,0182 
Ty = > y 
Ca $2 0 lpc2 
0 0 0 1 


Empleando las matrices de transformación, se observa que la posición > be de la 
masa ubicada justo en el extremo del péndulo está dada por la información de la 
cuarta columna de la matriz de transformación T}, es decir: 


lacı = 1,5152 
h 
Xm = | lası + 1,,C182 | 


lpc2 


Suponiendo que el centro de masa del primer eslabón se encuentra ubicado a una 
distancia 1.1 del origen del sistema de referencia {1}, se obtiene: 
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por lo que: 

0. 10.0 & -s4 0.0 ler 
le hoyo! -1.0.00[|5s a 00 0 
[$] - orh- 0010 0 0 10 0 
0001 0 0. 01 1 

le1s1 

= —l.101 

E 0 

1 


Empleando los datos anteriores se obtienen lo siguientes resultados: 


lard La 
velin | (5 | wt = | i E =I! = | j Tma e 


0 d 
donde I; es el tensor de inercia del primer eslabón, {C; } representa a un sistema de 
referencia cuyo origen se encuentra ubicado en el centro de masa del eslabón 1, con 
la misma orientación que (1). Para la masa m se tiene: 


lacı — 1,5182 —lad181 — lpd1c182 => lpd281C2 
xP, = | lası +lpcisa | vt = | ladici — lpárs152 + Ipáacica 
lp Ca —l 4282 


Empleando los cálculos anteriores, se obtienen las siguientes expresiones: 


r r x 
laġıcı laġıcı 


[vi] va ka usa 


= di 
j i i T r à ; 
T =laġısı — lpd10182 — lpd281C2 —lag1s1 — lpd10182 — lpg281C2 
[vi] Vm = laġıcı — lpġ1 8182 + lpg201C2 laġıcı — lpq1s182 + lpgac1Ca 
—lp4282 —lp4282 


[2 + l2s2] di + 2lalpġiġ2c2 + 1d 


por lo que la energía cinética y potencial para el primer eslabón son: 


i 1 j 
Tı (q. å) 3 [ma1?, + Isal Gi 
Ur = 0 


mientras que para el segundo eslabón se obtiene: 


T2(q. q) 


U2 = magl,ca 


1 ; S y 
3 [ma (12 + 1283] di + 2malalpdidoca + malz43) 
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con lo que se concluye que las energías cinética y potencial totales del sistema son: 


; 1 ; E e 1 2. 
T(q,4) 3 [m,l?, + ma (1 + 1753) + Lzz1] & + malalpdidaca + zm2lpá 


U(q) 


A partir de los resultados anteriores se obtiene el Lagrangiano del sistema: 


maglyca 


T(q,4) - U(q) 


1 $ ii 
= 3 [mil Ea mal? ES məl? s3 -+ IARR] di + malalpdidaca 


L(q.4) 


1 o. 
+=mal q — maglycz 


2 Pp 


Para obtener las ecuaciones dinámicas del sistema se calculan las siguientes derivadas: 


OL 3 a 
— = [mill, + mai + malosa + 1:21) dí + malalpd2c2 


04 
d ƏL 
SL um 12 22 + mas + 1221) ¿ 2lalpGae 
di då, [m c1 + Mal, + M2lp32 + hal qı + Malalpq2C2 
+2moId1425202 — Malalp43sa 
OL 
— = () 
09 
OL 
Ji = Malalyd1C2 + malzdo 
d OL 5 Fy i 
T di = Mməlalpğıc2 + Məlpğ2 — Malalpdi 4282 


£ 


a malosoc24 — malalpdid252 + maglps2 


Empleando los cálculos anteriores se obtienen las ecuaciones dinámicas del sistema 
como se muestra a continuación: 


F [m2 + ml? + malós3 + Izzi] di + Malalpáaca + 2mal¿d1 428202 


—malalp43s2 
0 = malalpiica + molia - malidis2Ca — magl,s2 
Defínanse las siguientes matrices: 
2 + mal? T məl?s3 + Izz malalpca | 


> mil 
M (q) = | malal,Co mal? 
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2o 2: . 

malo d282C2 mal; d182C2 — Malalydos2 | 
2 . 

—Malodi 8202 


0 
G (q) = | ek |.r- o 


entonces las ecuaciones dinámicas del péndulo invertido rotacional pueden expresarse 
como: 


C (q, 4) = 


M(q)a + C(a.å)å + G(q) =T 


Una propiedad importante de la estructura anterior es que: 


0 malalyd282 ES 2mol dı 8202 | 


M(q) o 2C(4, q) = | a [malalpġ2s2 m% 2mal241 82c2] 0 


lo cual implica que la matriz M — 2C es antisimétrica. 


En esta Sección se presentan sistemas adicionales en los que pueden emplearse las 
ecuaciones de EL para obtener las ecuaciones dinámicas. Primero se presenta un caso 
de un robot de articulaciones flexibles y se concluye con la aplicación de las ecuaciones 
EL a sistemas eléctricos. 


5.5.1 Robot de articulaciones flexibles 


A lo largo del libro se ha considerado como suposición general la rigidez del robot. 
Sin embargo, es posible emplear las ecuaciones EL para obtener las ecuaciones dinámi- 
cas de robots cuyas articulaciones sean flexibles. Dicha flexibilidad puede presentarse 
cuando se emplean elementos de transmisión como bandas elásticas o ejes de trans- 
misión largos. La complicación inicial con dichos sistemas es que su modelado requiere 
del doble de coordenadas generalizadas, lo cual implica que el número de entradas de 
control del sistema es menor que el de grados de libertad. Por lo tanto, éstos robots 
son sistemas subactuados. 


A continuación se obtendrán las ecuaciones dinámicas del robot manipulador 
mostrado en la figura 5.28, el cual es un robot manipulador que consta de dos ar- 
ticulaciones rotacionales y cuyas articulaciones son flexibles. El modelado se basa en 
dos suposiciones [?|: 
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1. La energía cinética de los rotores en las articulaciones se debe a su propia 


rotación, y el movimiento del rotor es una rotación pura con respecto a un 


sistema de referencia inercial. 


bo 


La inercia del rotor y la transmisión son simétricas con respecto al eje de rotación 


del rotor, por lo que la energía potencial gravitacional del sistema y la velocidad 
del centro de masa del rotor son independientes de la posición del rotor. 


Figura 5.28 Robot planar con articulaciones flexibles. 


Para modelar al robot, se supone al mismo como un robot de 2 GDL con articula- 


ciones rotacionales, y la elasticidad se modela como un resorte torsional con constante 


de rigidez k,,, i = 1,2, como se indica en la figura 5.29. 


Eslabón 27 ya 
Articulación 2 s1 
Eslabón 1 die 
Articulación 1 


Figura 5.29 Modelado de la elasticidad por medio de resortes torsionales. 
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Suponiendo que los actuadores son motores, el acoplamiento elástico de los ejes de 
los motores con los eslabones introduce grados de libertad adicionales. Por lo tanto, 
los rotores de cada actuador se pueden modelar como cuerpos rígidos adicionales, lo 
cual implica que el robot contará con dos eslabones base y dos eslabones adicionales 
debido a los rotores. 


Empleando las consideraciones anteriores, se tienen cuatro variables en el sistema: 
41.42 que representan la posición angular de los eslabones 1 y 2, respectivamente; 
61.02 que representan la posición angular de los rotores 1 y 2, respectivamente, como 
se indica en la figura 5.29. Por lo tanto, el vector de coordenadas generalizadas del 
sistema es: 


q 
(o 


qı A 
--(3)-[3)-[3 


El procedimiento para obtener las ecuaciones dinámicas es similar al realizado con 
robots rígidos, por lo que primero se obtiene la tabla de parámetros DH como se 
muestra en la tabla 5.7. 


Tabla 5.7 Parámetros DH para robot de articulaciones flexibles. 


| i | oia [aa | di |8; | 
1 [ 0 [ 0 [0[a| 
2| 0 |Z: [0 [a | 


Empleando los parámetros DH se obtienen las matrices de transformación corres- 
pondientes: 


| C1 —$81 0.0 ] | Ca —$92 0 Lı ] 
o_o e YU 1 s> cd 0 0 
i 0 1o =| o 0 1o] 
0 0 0 1 | | 0 0 0 1 | 
ci -=s12 0 Lic, 
o_| sie 2 0 Lis; 
a 0 0 1 0 
0 0 0 1 


Los vectores que ubican los centros de masa de los eslabones son p..;, Peg para el 
primer y segundo eslabón, respectivamente, y sus valores son: 


g A 
ph=]| 0 |, ph=]| 0 
0 0 
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Empleando las matrices de transformación homogénea se obtiene la representación 
de dichos vectores con respecto al sistema de referencia (0): 


| lic | Lici + l2C12 
Per | z r| Pi | _| usi | Pea | = T? | Pío | _ | ası + ldos12 
1 E 1 o 0 | 1 ES 1 o 0 
1 1 


por lo que los vectores que ubican los centros de masa de los eslabones son: 


lic; L1c1 + lacra 
[ Po ] = l181 al pl, = Lis + l2819 
0 0 


Ahora se calculan los Jacobianos relacionados con el movimiento lineal: 


A —1181 0 
Jo, pa 0|= hs 5 


á e a | —Lis1 — l2s12 —l2s12 
Mes = | e Te | = Lıcı + lacra lacio 
0 0 
En adelante se supondrá que M.i, Mr i corresponden a la masa del ¿-ésimo eslabón 
y el ¿-ésimo rotor, respectivamente. La energía cinética total 7, y relacionada con el 
movimiento traslacional de los eslabones se obtienen agregando la masa del ¿-ésimo 
rotor a la del ¿-ésimo eslabón, es decir: 


1 EN f 
Tiv = 34 [lma + mala] J, + [mua + mall] Ja] 4 
con: 


2 
[mi + mal. - l [ma +m] 0 | 


0 0 


[mi2 + my.2][L? T E: + 2L¡l2c2] [mi2 T mr 2il + Li laca] 


Ie: a 
[mi 2+m».2][J,.] des o | [mi2 + m2) [23 + L1laco] [mi2 + mr, 2)13 


Los Jacobianos relacionados con el movimiento rotacional se obtienen a conti- 
nuación: 
| 0.0 ] 
0 0 


e [ioj [i1] 


Empleando las matrices de rotación se obtiene la siguiente transformación: 


0 0 0 0 
J= [RIIS =| 0 0 |32, = RIT, =] 0 0 
1 0 O | 
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Los tensores de inercia E Eo de los eslabones 1 y 2, respectivamente, se con- 
sideran con respecto a los ejes principales de inercia, por lo que tienen la siguiente 
estructura: 


Ti zzi 0 0 Dra? 0 0 
E, = 0 fiagi 0 , a = 0 is 0 
0 0 ha 0 0 Tisso 


Con los resultados anteriores, se puede calcular la energía cinética T} w relacionada 
con el movimiento rotacional de los eslabones: 


1 F 
Ti w = A MT g bs [32,]* aJa] q 
donde: 


T Mzz 0 T : zz 1 ¡22 
[J2] Budo = | 5 j 0 | [aa] DaJa = | p o pom | 


Ahora se obtiene la energía cinética T}, correspondiente a la energía cinética total 
de los eslabones: 


1 
Ti = Tiv + Ti = z4 Mila) (5.66) 


donde la matriz Mı(q) tiene la siguiente estructura: 


=| Mia Mi2 
Mi(q) | ma mas | (5.67) 


y los elementos mij son: 


[mi + ma] + [m2 + ma] [Li +13 + 2111202] + Di.221 + 11,222 
[mi 2 + m, all? + Liloco] + Ii,zz 
ma = [m2 + mna] + Lilaca] + 1.222 


mii 


mi2 


m22 [mi2 + mr 2l? + Íiz22 


(5.68) 


Como el robot se mueve en el plano horizontal, se concluye que la gravedad no tiene 
efecto en los eslabones, por lo que la energía potencial debido al efecto gravitacional 
es nula. 


Para la parte correspondiente a los rotores, la energía cinética se calcula empleando 
la siguiente expresión: 


T, = 392 [mn [0] o: + [oR] Tog 


donde: 
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Mr, es la masa del rotor i 


y. es la velocidad lineal del ¿-ésimo rotor, expresada en el sistema de referencia 
{ri} asignado al ¿-ésimo rotor. 


Ti 


wri es la velocidad angular del rotor ¿ expresada en el sistema de referencia {r;}. 


Ty: es el tensor de inercia del rotor ¿expresado en el sistema de referencia (r;). 


De acuerdo a las suposiciones iniciales, se considera que el centro de masa del rotor 
se encuentra sobre su propio eje de rotación. Nótese también que, en la expresión de 
T,, la primera parte correspondiente al movimiento lineal ya se incluyó en T; al agregar 
la masa de los rotores. Para la segunda parte de T, correspondiente al movimiento 
rotacional, la velocidad angular w;: se obtiene empleando los resultados obtenidos en 
la sección de las ecuaciones de Newton-Euler. Por lo tanto: 


ri 


ri j=] 4 
wi = Ril¡0j ¿1 + 014; 


E ga ŠJ : 
wii = Ri_¡01-1 +40; 


donde: 


wi; es la velocidad angular del eslabón ¿ en el sistema de referencia {i} asignado a 


dicho eslabón. 
a; es el vector constante a; = [0,0,1]7. 
ĝi es la velocidad angular del rotor ¿. 


q; es la velocidad angular del eslabón i. 


Con las fórmulas anteriores se obtiene: 


w, = Riwjo+ó101 
à si 0 0 0 | 0 ] 
= |-=s e 0 0l++0]=| 0 
0 0 1 0 ó | ó | 
0 
wi = Riop+qa= | 0 
4 
Wi, = Rw}, + ġ2a2 
co se 0 0 0 0 
= -S2 Ca 0 0¡+|0j|= un 
0 0 1 | 4 Ó2 di + Ó2 
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Ahora se calculan las siguientes expresiones: 


0 z Laa 0 0 0 
] T a 0 0 Ir yy! 0 0 
Åi 0 0 Ir zz1 01 
pr (5.69) 
FR = | 0 | | 0, | | 9 
3 :] : | 4 + d2 | | o o Laaa ] L dı + d2 | 
= Insald + $2)? (5.70) 


por lo que la energía cinética debida a los rotores es: 
PAR | e TE 
Ir.22101 + z122 lá, + å 


Al considerar la suposición de que la energía cinética de los rotores se debe a su 
propia rotación, se obtiene: 


1 r 
01 Ty 1001 


1 
2 za r,z 2:10) 


1 1 
¿2 Trw E nl r, ::20% 


y la energía cinética T, se reduce a: 


1 : X : E 
T, = 3"11r::101 + 3"21r,22207 (5.71) 


donde r,,r2 son las relaciones de las transmisiones que se empleen en los rotores 1 y 
2, respectivamente. 


Ahora se consideran los resortes torsionales en las articulaciones, los cuales alma- 
cenan energía potencial U. que se representa de la siguiente manera: 


1 
U.(q, $) = Ska [q — 611? + Es [g2 — da)? (5.72) 
donde k,,,k,, son los coeficientes de rigidez de los resortes 1 y 2, respectivamente. 
Sumando la energía cinética debida a los eslabones y los rotores, (5.66) y (5.71), 
se obtiene la energía cinética total T(q, q) del sistema: 


T(4,4) = ¡Mg (5.73) 
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donde: 
ma Mı? M3 ma | 


; re ma Maz M23 Mas j 
M(q) = | a du fa ma | (5.74) 


Mar Ma Maz Mas 


y los valores de los elementos mij son: 


mi = [ma +m? + [m2 + m,2][1? + 12 + 2L1l202) + Liza + Izz 
my =  [mi2+m»2][l + Lrlaca] + 11.2: 
ma = 0 

ma = 0 

ma = [m2 + mall + Lilaca] + l,z22 
mz = [m2 +mr2]l + l, 

məz = 0 

ma = 0 

ma = 0 

Map = 0 

m33 = bs 

Mia = 

ma = 0 

ma = 0 

Ma = 0 

Mas = bin 


Nótese que la matriz de masa (5.74) puede reescribirse de la siguiente manera: 


Aa Mı(q) 02x2 
s= | 02x2 Mə 


donde: 
Mı(q) = | mo PU | M = l los | 


mə} Maz 0 Mas 


Empleando la matriz M(q) se pueden obtener los términos correspondientes a las 
fuerzas centrífugas y de Coriolis, empleando los símbolos de Christoffel: 


es 1 [ms di dm pi a Sl 
“e” 2l| 9 04; qk 


Cikj 
Cik = e 4 
Cnkj 
donde Cj; es el jk-ésimo elemento de la matriz C'(q.q). Los valores de los símbolos 
de Christoffel se muestran en las tablas 5.8-5.11. 
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Tabla 5.8 Símbolos de Christoffel c111 — C144- 
cu1=0 C112 = [Mr 2 + m12]L1l282 C14 = 0 
ci21 = [Mmr 2 + m¡2]L1l2s2 | c122 = 0 C24 =0 
c1i31 = 0 Ci32 =0 Cig4 =0 
C141 =0 Cia2 =0 Ci44 =0 
Tabla 5.9 Símbolos de Christoffel €211 — C244- 
cam = —[m,.2 + m,2]L1l282 ca14 =0 
c221 = —[m,.2 + m,2]L1l282 C224 =0 
C231 =0 C234 = 0 
C241 = 0 C244 = 0 


Tabla 5.10 Símbolos de Christoffel €311 — €344- 


c311 = 0 
c321 = 0 
331 = 0 
3411 = 0 


c314 = 0 
c324 = 0 
C334 = 0 
C344 = 0 


Tabla 5.11 Símbolos de Christoffel c411 — C444. 


Ca1 = 0 
C421 = 0 
Cag1 = 0 


C441 = 0 


C44 = 0 
C424 = 0 
C434 = 0 
Casa = 0 


Empleando los símbolos de Christoffel se obtiene la matriz C (q, q): 


—[m+.2 + mı, 21L1l24282 
[m, 2 + m2] Li l241 82 


C(q,4) = ; 
0 
- (n (ze 
02x2 02x2 
donde: 
oaea = | Tanaim taaa 


Alfaomega 


= [mr 2 + mi2} Liləlġi + åġ2ļs2 0 0 
0 0 0 
0 0 0 
0 0 0 


= [m, 2 + m2] Liloldr + 42)82 
0 
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Al igual que en ejemplos anteriores, se puede verificar que se cumple la siguiente 
relación: 


5" [N (a) — 2C(4,4)]s 


para cualquier vector s € IR*, es decir, la matriz M(q) — 2C (q, 4) es antisimétrica. 


La energía potencial total del sistema es: 
1 T 
U(x) = ¿la— 4l Kla- él 
donde la matriz K es la matriz de rigidez de los resortes y tiene la siguiente estructura: 


„r | ka 0 
ra|” A 


con ks1, ks2 la constante de rigidez de los resortes 1 y 2, respectivamente. Por lo tanto, 
el vector de pares gravitacionales es: 


EL Kla- ¢ ' 
9(q) =e | avig | . | le (5.76) 


En este ejemplo se considerará el efecto de la fricción tanto de Coulomb como 
viscosa. Dicho efecto se introduce al sistema como fuerzas no potenciales. Por lo 
tanto, las fuerzas generalizadas correspondientes a cada coordenada generalizada son: 


Qı = —fig1— fer tanh(841) 
Q2 = —fado— fez tanh(Bd2) 
Q3 = n- fi01 — fegtanh(861) 


Qa = T2- fió2— fegtanh(Só2) 
(5.77) 


donde 


fı coeficiente de fricción viscosa del eslabón 1 


f2 coeficiente de fricción viscosa del eslabón 2 


Í: 


fa coeficiente de fricción viscosa del rotor 2 


coeficiente de fricción viscosa del rotor 1 


a 


fea coeficiente de fricción de Coulomb del eslabón 1 
fe2 coeficiente de fricción de Coulomb del eslabón 2 


fea coeficiente de fricción de Coulomb del rotor 1 
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f. coeficiente de fricción de Coulomb del rotor 2 
Tı Par generado por el motor 1 


Ta Par generado por el motor 2 


En un sistema real, los pares aplicados en las articulaciones pueden escribirse 
como: 
Ti kti Imı 
a ag = TIm 
T2 ki21m2 


0 Lot 
Ln = m 
kiz | | Im2 


donde kz, ke, Im1, m2 son las constantes de par de los motores 1 y 2, y las corrientes 
de los motores 1 and 2, respectivamente. Los elementos de fricción viscosa se pueden 


agrupar como: 
Fa=|£ 0 | ¡ma = fa 0 | 


9 
| 


con: 


r= 


| 
p 
oSs 
ad 


0 f 0 fa 


y los elementos de fricción de Coulomb se pueden agrupar como: 


fes tanh(8ġı ) 
Fes tanh(B62) ` 


fea tanh(8q1) 


fez tanh(8d2) | , Saló) = | 


tata) =| 


Ahora se emplea un sólo término que incluye los elementos de fricción: 
Filà) = Fad + falà), Fe(b) = Fo2ġ + F.2(6). 


Con las factorizaciones anteriores se obtiene de modo final el conjunto de ecua- 
ciones dinámicas que describen al robot de articulaciones flexibles: 


Mi(q)a + Cala, )a + Fil) + Kla- ġ)] = 02x2 (5.78) 
Mz2¢ + Fa(d) + K[ġ — q] 7 


5.5.2 Circuitos eléctricos 


Una aplicación adicional que se les puede dar a las ecuaciones EL se enfoca en el 
análisis de circuitos eléctricos. Se sabe que los sistemas mecánicos guardan muchas 
similitudes con los sistemas eléctricos y esta circunstancia permite que las ecuaciones 
EL, considerando sistemas de primer orden, puedan aplicarse a sistemas eléctricos. A 
continuación se mostrará la forma en que puede llevarse a cabo dicha aplicación. 
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En el análisis de circuitos eléctricos hay tres elementos pasivos que aparecen 
comunmente en la práctica: la resistencia, el inductor y el capacitor. Para el análisis 
con la resistencia se sabe de la Ley de Ohm que ur (t) = Ri(t), donde up (t)es el 
voltaje, i (t) la corriente y R la resistencia. Para el inductor, el voltaje en sus termi- 
nales puede determinarse mediante la expresión: uz (t) = Ldi (t) /dt, siendo uy (t) el 
voltaje, i(t) la corriente y L la inductancia. Finalmente, para el capacitor se tiene 
la relación: uc (t) = C7! f i(T)dr, con uc (t) el voltaje en sus terminales, i(t) la 
corriente y C su capacitancia. 


En circuitos eléctricos se emplean las Leyes de Kirchhoff para establecer las 
ecuaciones dinámicas de los mismos. Dichas leyes se dividen en dos: 


1. Ley de mallas: establece que la suma de los voltajes a través de cualquier 
trayectoria cerrada de un circuito eléctrico es cero. 


2. Ley de nodos: establece que la suma algebraica de las corrientes en un nodo 
de un circuito es cero. 


Como ejemplo de obtención de las ecuaciones dinámicas de un circuito eléctrico, 
considérese el circuito RLC en serie mostrado en la figura 5.30. Al aplicar un voltaje 
e (t) se obtienen los voltajes de la resistencia up, del inductor uz y del capacitor uc. 
La suma de voltajes permite obtener la siguiente expresión: 


ur + uc +uL = 


Empleando las relaciones descritas anteriormente, se obtiene la siguiente ecuación: 


li 
Ri + L% +5 /údt=e (5.79) 


que se encuentra en función de la corriente i (t) que circula por la malla. Si en lugar de 
la corriente se emplea como variable la carga q (t), donde i (t) = dq (t) /dt), se obtiene 
la ecuación diferencial equivalente para el circuito: 


ža =e- Rå (5.80) 


Lä + 


o 
A 
y 


ti +t Il 


Figura 5.30 Circuito RLC en serie. 
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Sea ahora el circuito RLC en paralelo mostrado en la figura 5.31. Al al aplicar la 
ley de nodos se obtiene: 
ir+ic+ ir =i (5.81) 
donde ip (t) es la corriente a través de la resistencia, ic (t) la corriente en el capa- 
citor, iz (t) la corriente en el inductor e i (t) la corriente externa aplicada al circuito. 
Tomando u (t) como el voltaje en la resistencia, se concluye que: 


z + =S udt + Cù = i (5.82) 
o bien: di 1 
x i $ à 
Cü + I” a R“ (5.83) 


Figura 5.31 Circuito RLC en paralelo. 


Para un sistema mecánico que consiste en una partícula que se mueve linealmente, 
se tienen los siguientes valores de energía cinética, energía potencial y pares externos: 


r a. C 9 r 
T(44)=3538, Ula) = 59, T=E- bi 


donde T es la energía cinética, U es la energía potencial, € (t) es una fuerza externa 
no potencial actuando sobre la partícula, bġ (t) denota fricción viscosa y q (t) es la 
posición del elemento considerado. En este caso, el Lagrangiano del sistema mecánico 
es: 


L(q,4) = T(q,4) - U (q) = 


Empleando las ecuaciones EL, la ecuación dinámica que describe el movimiento 
del sistema mecánico considerado es: 


aq + cq = € — dq (5.84) 
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Por lo tanto, si se comparan las ecuaciones (5.80), (5.83) y (5.84), es posible obtener 
el conjunto de analogías mecánicas-eléctricas como se muestra en la tabla 5.12. 


Tabla 5.12 Analogías entre sistemas mecánicos y eléctricos. 


Sistema (coordenadas) | | | [r Jo p | 
Mecánico (posición 4) |a |0 |e | gap |z [Q0 | 


[Eléctrico (carga) |L |R|p |ie | |e Ri 
[Eléctrico (voltaje u) | C| 4|} |ior [he g ho 


A continuación se presenta un ejemplo que ilustra la aplicación del procedimiento 
anterior en un circuito eléctrico de dos mallas. 


Ejemplo 5.19 


Obtener las ecuaciones dinámicas del circuito de la figura 5.32 empleando las ecua- 
ciones de EL. 


Figura 5.32 Circuito eléctrico de dos mallas. 


Solución 


El circuito consta de dos mallas, a través de las cuales circulan las corrientes (11,12). 
Debido a lo anterior es que deben de existir dos ecuaciones que describan el com- 
portamiento del sistema. Se eligen como coordenadas generalizadas las cargas qı, q2 
correspondientes a las corrientes 11,12, respectivamente. Por lo tanto, el vector de 
coordenadas generalizadas es q = [q;, q2]*. 
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Empleando la tabla 5.12 se obtienen las siguientes equivalencias: 


a dq; A 
Le = y = di 
8 da. 
e a Td — 
Tí = e-— Ri q — Rald1 — de] 
To = —Ralús— q1] — Rada 
r E See y 
T(q.4) = 3594 F zal 
Ui = + 70 la a+ e 


Con las equivalencias anteriores se obtiene el Lagrangiano del sistema: 
Mis as 
¿di + 3 Lada — 


e — [a - al - —é 
20," Pe 2 = aa 


Para emplear las ecuaciones de EL se calculan las siguientes derivadas: 


OL 
— = LI 
dh 191 
d OL 
2 s pS 
dt 041 19 
ƏL le 
ðq cx qe Ca qı — 4 
OL 
— = ES J 
0d 242 
d OL 
LE. ea 
di Oda 242 
OL o 1 [ ] 1 
00 3A qı — 4% qa 


Al emplear las ecuaciones de EL se obtiene: 


d ƏL ƏL 


öh da = 


e — Rıġı — Ra [dí — do] 


1 
E ~ to == 
14 + qa ln q2] 


E ¿ : 1 
Liğı + [Ri + Ra] 1 — Roda + cn + 5 Im -q] = e 
1 2 
a i : 1 1 1 
Lada + [Ri + Rola — Rada + | tēla- qa = e 
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d ƏL ƏL 


dp õp ” 


á 1 1 i a i 
Logs — a [qı — 42] + Te —Ra [ġ2 — d1] — Raga 


Es y r 1 1 
Laa — Ragr + [Ra + Ra] qa — TG [qı — q2] + qa = 0 
e . P 1 1 1 
Lad2 — Raqr + [R2 + Ral qa — A + E + E q = 0 


por lo que las ecuaciones dinámicas del sistema son: 


Liğı + [Ri + Ro] d1 — Rodo + E i £l n- ¿4 =e 
Logs — Ros + [R2 + Ra] ġ2 ¿a+ [4 + &] Q=0 


Las ecuaciones anteriores pueden obtenerse empleando la ley de mallas de Kir- 
chhoff. Sin embargo, las analogías anteriores pueden servir para analizar sistemas 
más complejos, en los que se presenten tanto elementos eléctricos como mecánicos. 
En dichos casos, el uso de las ecuaciones de mallas o nodos no permitiría obtener tan 
fácilmente las ecuaciones dinámicas del sistema. 


En este Capítulo se analizaron algunos métodos para obtener las ecuaciones dinámi- 
cas de varios tipos de sistemas. Se inició el análisis con la obtención de las ecuaciones 
dinámicas de un robot manipulador, basándose en las ecuaciones de Newton-Euler. 
Dichas ecuaciones son importantes debido a que representan un método iterativo por 
medio del cual es posible obtener las ecuaciones dinámicas empleando un sistema com- 
putacional. Posteriormente, se procedió a emplear el formalismo de Euler-Lagrange 
para determinar las ecuaciones dinámicas de sistemas electromecánicos, haciendo la 
adaptación correspondiente que permite obtener las ecuaciones dinámicas de un robot 
manipulador. La ventaja del uso de dichas ecuaciones es evidente, debido a varias ra- 
zones: en primera instancia, las ecuaciones obtenidas por el método EL presentan una 
estructura bien definida que facilita el análisis del robot. Además, el procedimiento 
para obtener dichas ecuaciones es sistemático, por lo cual se simplifica el análisis del 
robot. 

Debe tenerse en cuenta que el análisis que se ha realizado a lo largo de todo este 
libro permitirá tener un conocimiento general acerca de la estructura cinemática de 
un robot y, además, de su comportamiento dinámico. A partir de este punto, es posi- 
ble considerar diversas técnicas de control que permitirán hacer que el manipulador 
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se comporte de manera adecuada en alguna tarea que le sea especificada. Una vez 
entendido el material que se ha presentado, el análisis de control del manipulador se 
facilita considerando el modelado con las ecuaciones EL, en especial si se emplea un 
análisis de estabilidad basado en el método directo de Lyapunov, ya que se pueden 
hacer simplificaciones importantes si se conocen las propiedades de ciertas matrices 
que aparecen en el sistema, como lo son la matriz de masa del sistema y la matriz de 
fuerzas centrífugas y de Coriolis. 


Finalmente, al terminar el estudio de los temas tratados a lo largo de este libro se 
espera que el lector cuente con los conocimientos básicos que requiere para entender 
el proceso de diseño de estrategias de control. Sin duda, el estudio de dichos temas 
es demasiado amplio debido a que existen muchas técnicas que pueden aplicarse con 
diversos tipos de objetivos, pero en general su aplicación será más sencilla si se tiene 
en claro la interpretación de las ecuaciones básicas que describen al manipulador que 
se desea controlar. 


5.1 ¿Qué son las ecuaciones dinámicas y cuáles son los tipos de problemas en los 
cuales se pueden aplicar?. 


5.2 ¿Qué es el tensor de inercia y para qué puede ser empleado?. 
5.3 ¿Cuál es la ventaja del uso de las ecuaciones de Newton-Euler?. 


5.4 ¿Cuál es la ventaja del uso de las ecuaciones de Euler-Lagrange en lugar de las 
ecuaciones de Newton-Euler?. 


5.5 Indique qué son las coordenadas generalizadas y a qué corresponden de modo 
general en un robot manipulador. 


5.6 ¿Qué establece el principio del trabajo virtual?. 
5.7 ¿Qué establece el principio de D'Alembert?. 


5.8 Sea el prisma de la figura 5.33. Determinar su tensor de inercia con respecto al 
sistema de referencia {1}. 


Alfaomega Cinemática y Dinámica de Robots Manipuladores e Roger Miranda Colorado 


5.7 Ejercicios 337 


Figura 5.33 Cálculo de tensor de inercia de un prisma. 


5.9 Sea el cono de la figura 5.34. Determinar Irr, [yy e I++ con respecto al sistema 
de referencia {1}. 


Figura 5.34 Cálculo de tensor de inercia de un cono. 


5.10 Empleando las ecuaciones de Newton-Euler, determinar las ecuaciones dinámicas 
del robot manipulador mostrado en la figura 5.35. 


Figura 5.35 Cálculo de ecuaciones dinámicas empleando el método de Newton-Euler. 
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5.11 Obtener las ecuaciones dinámicas del robot mostrado en la figura 5.36 empleando 
las ecuaciones EL. 


Figura 5.36 Cálculo de ecuaciones dinámicas empleando las ecuaciones de EL. 
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A continuación se presentan algunos conceptos referentes al álgebra lineal. No se 
pretende hacer un estudio exhaustivo al respecto. Sólo se hará hincapié en los temas 
de interés especial. 

Definición (Vector, [4]) Un vector v de n componentes se define como un con- 
junto ordenado de n elementos escritos de la siguiente manera: (11, A para un 
vector columna y [%1,...,2n] para un vector fila, donde la operación [-]? denota la 
transpuesta de su argumento. 

Se emplea la notación IR” para referirse al espacio vectorial al cual pertenecen 
todos los vectores de n componentes, donde cada elemento del vector es un número 
real. 

Los vectores son un conjunto de segmentos de recta equivalentes, por lo que la 
magnitud o longitud de un vector se define como la longitud de dicho segmento de 
recta y se obtiene mediante la siguiente expresión: 


lIv]| = magnitud de v = y zf +23 +--+ z2 


La dirección de cualquier representación de un vector v se define como el siguiente 
vector u de magnitud unitaria: 
v 
u= — 
M 
Definición (Matriz, [4]) Una matriz M de m x n es un arreglo en forma rectan- 
gular de mn elementos acomodados en m filas y n columnas de la siguiente manera: 


411 a12 ++ Qij  *** Qin 

a21 22 =" js === Ofn 

M = ` 
| Qil Qi? +++ Qij  *** Qin | 
| Aml Am2 *** Amj *** Amn | 


Definición (Producto escalar, [4]) Sean u,v € IR” dos vectores. Su producto 
escalar (también denominado producto punto o interno) está dado por: 


u.v=u'v= (u, v) = uvi ++: + UnUn 
T cy 
donde u = ftinn] y v= [0,.. 02)". 
La expresión A € M"*" representa a la matriz A, la cual pertenece al conjunto de 


matrices de orden n x n. La expresión v € IR” representa al vector v que pertenece al 
espacio IR”. Cuando se emplean escalares, pueden especificarse mediante la notación 


a € lR. 
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Para un vector v € R”, la norma ||-|| es una función valuada en los reales que 
cumple las siguientes propiedades [5]: 


(i) ||v|| > 0 para todo v # 0 
(ii) ||v|| = 0 implica que v = 0 
(iii) llav!|| = [a] ||v||, donde a es un escalar y |-| denota la función valor absoluto 


(iv) lu + vl] < llull + Iiv 


Dada la matriz A € M”*”, su diagonal principal consiste en los elementos a;;, i = 
1,....n. Cuando una matriz contiene únicamente valores no nulos en su diagonal prin- 
cipal se dice que dicha matriz es diagonal y se representa como A = diag [a;1,....Qn). 
Por ejemplo, la matriz I„ = diag [1,...,1), Z € IR"*”, es la matriz identidad de orden 
n y se representa como: 


lo o,sii=j 


ln = (04), da =d 0 ,siižj 


Definición (Inversa de una matriz, |4]) Sean A, B € IR"*". Si AB = BA =I, 
se dice que B es la inversa de A y se representa como AT}. Además: 


AA! = A'A =I 


y cuando A”? existe se dice que A es invertible o no singular’. 


Teorema (Inversa del producto de matrices, [4]) Sean A y B dos matrices 
invertibles, entonces AB es invertible y: 


(AB)? =B-147! 
Definición (Determinante) Sea A € M?*?, se define su determinante como: 
det (A) = a11432 — 412421 


donde a;j corresponde al ¿j-ésimo elemento de la matriz A. 


Teorema. Sea A € M?*?, entonces: 


1. A es invertible si y solo si det (A) 4 0 


2. Si det (4) # 0, entonces 


== 1 l a22 a 
det (A) — a2) 011 


l Cuando la inversa de una matriz existe, ésta es única. 
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Definición (Transpuesta de una matriz) Sea la matriz A € M"*”. Su transpues- 
ta se obtiene al intercambiar sus renglones por las columnas de A y se expresa como 
AT, donde A = (aij) € M™*” y AT = (aji) € M"*"”, 

Definición (Matriz simétrica) Se dice que A € M"*” es simétrica siempre que 
A=A?7. 

Definición (Menor, [4]) Sea A € M”*” y sea M;i; € MU-Ux("=0 la matriz que 
se obtiene al eliminar el ¿—ésimo renglón y la ¿—ésima columna. La matriz Mij se 
denomina menor ij de A. 


Definición (Cofactor, [4]) Sea A € M"*" y Mij el menor ij de A, entonces el 
cofactor ij de A, denotado por A;j, se obtiene como: 


Ai; = (-1)** det (My) 


Definición (Determinante, forma general) Sea A € M”*”, entonces: 
n 
det (A) = an An + a2 412 +++ +inÁArmn = e aikAik 
k=1 


y a dicha expresión se le denomina expansión por cofactores. 


Definición (Matriz positiva definida, |5, 11]) Una matriz simétrica M € IR”*” 
se dice que es positiva definida, denotándose como M > 0, cuando se cumple: 


x"Mx>0 


para todo x % 0, x € IR”. Si x" Mx > 0 se dice que M es positiva semidefinida 
(M > 0). Finalmente, se dice que M es negativa definida (M < 0) si —M es positiva 
definida. 


Teorema (|4|) Sean A, B € M”*", entonces: 


det (AB) = det (A) det (B) 


Teorema (|4]) Dada A € M"*”, se cumple: 
det (A) = det (4%) 


Teorema (|4|) Sea A € M”*” una matriz no singular. Entonces: 


1 


det (473) = det (A) 


Las dos propiedades que definen de manera específica a los vectores son su mag- 
nitud y dirección. La magnitud de un vector se define como la norma del mismo, 
donde normalmente se considera la norma ||-[|,. o simplemente ||-[|, conocida como 
norma Euclideana. De esta manera, dado el vector v € R”, se define su norma como: 


lvll= ye? +---+02 
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mientras que la dirección del mismo se define como: 


ani v 
dirección de v = —- 
ivil 
Existen vectores especiales como el caso del vector unitario, que es cualquier 


vector de magnitud unitaria. Además, es importante recordar que el producto escalar 
de dos vectores u, v € R” también puede representarse mediante la siguiente ecuación: 


u - v = |jul] [lv] cos ó 


donde ġ es el ángulo entre dichos vectores?. 


Dos vectores son paralelos si el ángulo entre ellos es cero o 180° y son ortogo- 
nales si el ángulo entre ellos es 90°. 

Definición (Proyección y componente de un vector, [4]) Sean u y v dos 
vectores diferentes de cero. La proyección de u sobre v, denotada por proy,u, se 
define como: 


mientras que la componente del vector u en la dirección de v es 


u-v 
M 


Normalmente, cuando se maneja el sistema de coordenadas cartesianas se suele 
usar la notación de vectores empleando los vectores unitarios base {i,j,k} que son 
los vectores unitarios en las direcciones de los ejes x,y,z respectivamente. De esta 
manera, el vector v = [2,3,4]” puede expresarse como v = 2i + 3j + 4k. 


Definición (Producto cruz o vectorial, [4]) Sean u = uii + usj + usk y v = 
vii + vj +v3k. El producto cruz o vectorial entre los vectores u y v se representa por 
u x v y se define como: 


[u, v] =uxv= [uzvz baa uzu»] i+ [uzv E uU3]j+ [uy va - u301] k 


Es importante recordar que si w = u x v, entonces w es ortogonal tanto a u como 
a v, lo cual se representa de la siguiente manera: 


wluwlv 
Otro elemento importante en el análisis de la robótica es la regla de la mano 


derecha, la cual establece que si se se coloca la mano derecha de modo que el dedo 
índice apunte en la dirección de un vector u y se cierra la mano hacia el vector v 


2Recuérdese que el ángulo entre dos vectores diferentes de cero es el ángulo más pequeño entre 
las representaciones de dichos vectores y que tienen el origen como su punto inicial. 
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siguiendo el camino del menor ángulo entre dichos vectores, entonces el dedo pulgar 
apuntará en la dirección de u x v. Lo anterior es de gran importancia debido a que los 
sistemas de coordenadas estudiados en este texto se basan en sistemas coordenados 
con orientación derecha, es decir, sistemas de coordenadas que cumplen con la regla 
de la mano derecha. 


Teorema (|4|) Sea 6 el ángulo entre u y v, entonces: 


lu x vl] = [ful] Iiv] sin 6 


Definición Sean vı, ..., Vn vectores en un espacio vectorial V. Entonces, cualquier 
vector de la forma: 
Q1V1] F = ANa 
con (Q7,..., @n escalares, se denomina combinación lineal de v1, ..., Vn- 


Definición (Dependencia e independencia lineal entre vectores) Sean los 
vectores Xj7.....X, en un espacio vectorial V. Se dice que dichos vectores son lineal- 
mente independientes si existen escalares @1,...,@n tales que la igualdad: 


Q01X1 +***QnXn =0 


se cumple únicamente cuando Qa = 42 =-**= an =0. 


Definición (Base) Un conjunto finito de vectores [v;,..., Vn} es una base de un 
espacio vectorial V si: 


1. [v1,.... v,) son linealmente independientes 


2. [v;,..., Vn) genera a V 


Definición (Dimensión) Sea V un espacio vectorial con base finita (el número de 
elementos de su base es finito), entonces se define la dimensión de V como el número 
de vectores de su base. 


Definición (Matriz de transición, |4]) Sea V un espacio vectorial y sean Bı y 


Bə dos bases del mismo espacio vectorial. Supóngase que [x] p, representa al vector x 
en términos de la base Bı, entonces, a la matriz A tal que: 


xx], = A [x]s, 


se le denomina matriz de transición de Bı a B2. De igual manera, A`! es la matriz 
de transición de B a Bı. 


Definición (Conjunto ortonormal) Sean los vectores {v1, ..., V} € R”. Se dice 
que dicho conjunto es ortonormal si 


wi Vj = 0,45% 3 
Vi Vi = 1 


y si sólo se satisface la primera ecuación se dice que el conjunto es ortogonal. 
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Definición (Matriz ortogonal, [4]) Sea Q € M"*”. Se dice que Q es ortogonal 
si Q es invertible y: 


ge = gF 


Definición (Transformación Lineal) Sean V y W espacios vectoriales reales. 
Una transformación lineal T : V > W es una función que asigna a cada vector v € V 
un único vector T (v) = w € W que satisface, para cada u, v en V y escalar a, las 
siguientes expresiones: 

T(u+v)=T(u)+T (v) 


T (au) = aT (u) 


Teorema (Matriz de transformación, [4]) Sea T : R” => R™ una transforma- 
ción lineal. Entonces existe una única matriz Ar € M'"*” tal que: 


T (x) = Årx 
para toda x € R”. La matriz Ay se denomina matriz de transformación correspon- 


diente a T o representación matricial de T. 


Definición (Matrices semejantes) Se dice que dos matrices A y B en M”*” 
son semejantes si existe C € M”*" tal que: 


B=C"*AC 


El siguiente resultado es útil cuando se estudia el cambio de representación de un 
operador expresado en un cierto sistemas de coordenadas y se requiera expresar a 
dicho operador en otro sistema de coordenadas. Debido a ello es que se muestra la 
demostración y análisis de dicho resultado. 


Teorema ([4]) Sea V un espacio vectorial de dimensión finita con bases Bı = 
[v1,.... Vaj y B2 = [wi,..., Wn} y sea T : V > V una transformación lineal. Si Ar 
es la representación matricial de T con respecto a Bı y Cr la misma representación 
con respecto a Ba, entonces Ay y Cr son semejantes. 


Prueba. Se observa claramente que [Tx] g, = Ar [x] y, y [Tx] y, = Cr [x] y, y sea 
M la matriz de transición de Bı a B2, entonces [x], = M [x] y, , por lo que: 


[Tx] y, = Cr [x]p, = CrM (]p, = M[Tx] p, 
de esta manera, multiplicando por M`? en la igualdad anterior se obtiene: 
[Tx] p, = M7*CrM [x]p, = Ar [x]s, 


de donde se deduce que: 
Ar =M"*Cr7M 
por lo que se comprueba que Ar y Cr son semejantes. 


El resultado anterior es importante debido a su aplicación en robótica. Se observa 
que la matriz de transformación M de Bı a B2 puede considerarse, tomando los 
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sistemas de referencia {0} y {1}, como Rå, por lo que dado el operador S* (operador 
expresado en el sistema de coordenadas 1), su expresión en el sistema de coordenadas 
{0} está dado por: 
=] T 
S° = [R6] SRo = [R1] $° [R5] 


debido a las propiedades vistas para las matrices de rotación. En el análisis realiza- 
do en el texto se maneja éste resultado apelando al concepto de transformación de 
similaridad. 
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Apéndice B. Cinemática Inversa 


En el desarrollo del libro se trata únicamente al análisis cinemático directo de los 
robots manipuladores, donde se ha centrado la atención en la obtención de la posición 
y orientación del efector final del manipulador en función de las variables articulares. 


Un problema que surge con frecuencia en robótica es el de la determinación de los 
valores de las articulaciones que permiten tener una posición y orientación específica 
en el manipulador. Éste es el problema de cinemática inversa, el cual consiste en 
la determinación de las variables de las articulaciones en función de la posición y 
orientación del efector final. 


Dado un valor determinado de las variables articulares y una matriz de trans- 
formación homogénea, es posible determinar de modo único el valor de la posición 
y orientación del manipulador. Sin embargo, el problema inverso, i.e., la cinemática 
inversa, se complica debido a que el proceso de obtener los valores de las variables ar- 
ticulares en función de la posición y orientación del efector final involucra un conjunto 
de ecuaciones no lineales que pueden tener múltiples soluciones o incluso la solución 


puede no existir. 


Si el problema de cinemática inversa tiene múltiples soluciones, significa que el 
manipulador puede adoptar diversas configuraciones que le permitan tener el valor 
deseado de posición y orientación. Si la solución no existe, se relaciona éste hecho con 
posiciones y/u orientaciones que el manipulador no puede obtener, por ejemplo si se 
encuentran fuera de su espacio de trabajo. 


Las técnicas para resolver el problema de cinemática inversa pueden ser muy di- 
versas y de modo general pueden clasificarse en: 


(a) Soluciones en forma cerrada o analíticas: se trata de soluciones o expresiones 
no iterativas que proporcionan de modo directo el valor deseado. 


(b) Soluciones numéricas: se trata de procedimientos iterativos que permiten la 
determinación del valor de una variable determinada. 


En las soluciones en forma cerrada puede emplearse el método geométrico, o el 
método algebraico. El método geométrico se basa en la geometría espacial del mani- 
pulador. El método algebraico consiste en el uso de expresiones algebraicas, basadas en 
relaciones con las matrices de transformación homogénea, para obtener una solución 
en forma cerrada. 


El análisis que se desarrollará en éste Apéndice será basado en el enfoque alge- 
braico, y se mostrará el modo de aplicar dicha técnica a un robot manipulador de seis 
grados de libertad. 


Relaciones trigonométricas 


Antes de comenzar el análisis de cinemática inversa empleando un enfoque al- 
gebraico, es importante conocer la solución de una serie de ecuaciones que surgen 
normalmente cuando se resuelven este tipo de problemas. 
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En los problemas de robótica de cinemática inversa, es necesario calcular un án- 
gulo O con base en las funciones sin 0 y cosó. Si se usa la función tan”! (-, +), no es 
posible determinar el efecto del signo del numerador o del denominador de los ar- 
gumentos, ya que dicha función siempre proporciona un ángulo que se encuentra en 
el primer o el cuarto cuadrante. Por lo tanto, si se requiere obtener el ángulo en el 
cuadrante adecuado se considera la función tan, : 7 = atan 2 (a,b), la cual se define 
de la siguiente manera: 


tan"! E .b>0 
tan”!i+r ,a>0,b<0 
tan $-r ,a<0,b<0 
a tan 2 (a,b) = z AS 0 
-5 „a <0,b=0 


no definida .a=b=0 


Por otro lado, existen algunas ecuaciones básicas que surgen de modo natural 
cuando se resuelve un problema de análisis cinemático inverso. A continuación se 
presentan dichas ecuaciones junto con su solución. 


Sea la ecuación: 
sinf = a 


entonces: 
cosh = +y 1 — a? 


por lo que la solución para ð es: 
0 = atan 2 (a, +vy1- a?) (5.85) 
Ahora se considera la ecuación: 
cos = b 


de donde se obtiene: 


sinf = +V1 - b? 


y las soluciones son: 


t= atan2(+V1-0,b) (5.86) 
Ahora, para el conjunto de ecuaciones: 
sin 0 = a, cos 0 = b 
la solución única está dada por: 


0 = atan 2 (a,b) (5.87) 
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Considérese la ecuación: 
acos + bsin = 0 


En este caso es evidente que: 


acosó = —bsin0 
a _ -a _ sin 0 
-b — b  cosô 


por lo que las dos soluciones a dicha ecuación son: 


9= atan 2 (a, —b) 
| atan2(—a,b) 


Sea ahora la ecuación: 
acos0+bsin0 =c 
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(5.88) 


Para resolver esta ecuación pueden emplearse las variables r, de la siguiente 


manera: 


a = rcosġ,b = rsin ġ 


donde: 
r = yal+bd? 
ó = atan2(b,a) 


Empleando las variables r, 4 en la ecuación original lleva a lo siguiente: 


r cos ġcos0 + rsinósin 0 
rcos(ġ — 0) 


cos (6 — 0) 


31/00 0 


además, empleando la identidad trigonométrica sin? y + cos? y = 1, se obtiene: 


sin ($ — 0) 


a 
+y1-3 
/ 2 
0-0- atma(+ === 
r? y 


Finalmente, las dos soluciones de la ecuación son: 


y entonces: 
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+y 1 — cos? (6 — 0) 


) 


0= tatan?2 (Va? +b? -8,c) + atan 2 (b, a) 


(5.89) 


Alfaomega 


350 Apéndice B Cinemática Inversa 


Considérese ahora el conjunto de ecuaciones: 


acos — bsin0 
asin + bcos 


Il 
a oS 


donde a, b, c,d son independientes. En este caso se emplean las siguientes relaciones: 


rcosġ,b = rsin ġ 
atan 2 (b,a) 


a 


por lo que: 
rcos(p+0) = c 
rsin (ġ +0) = 
y se obtiene la siguiente solución: 
0 = atan 2 (d,c) — a tan 2 (b, a) (5.90) 


Finalmente se consideran el conjunto de ecuaciones: 


acos +bsinf = c 
dsinĝ + ecos y 


donde a,b, c,d,e, f son independientes y se considera que: 


ad — be # 0 


El conjunto de ecuaciones anterior se puede reescribir como: 


a E cos 0 c 
sin 0 £ 
por lo que se concluye que: 


k-15 1 pa F g|- 1 þa 
sin 0 ad—-bel -e a F ad — be | af — ce 


y la solución para el sistema de ecuaciones es: 


0 = atan? (af — ce,cd — bf) (5.91) 


Todas las soluciones presentadas anteriormente se resumen en la tabla B.1. 
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Tabla B.1 Soluciones de ecuaciones con funciones trigonométricas. 


=b 
sin ĝ = a, cos 0 


só=0b 
acos +bsin0 = 0 
pa 


5 | acosó + bsin0 


acosĝ —bsin0 = c 
pr o T 0 = atan2 (d,c) — atan 2 (b,a) 


acos + bsin0 = c 
dins 0 = atan2 (af — ce,cd — bf) 


Ecuaciones de cinemática inversa 


La cinemática inversa consiste en la búsqueda del vector q (t) = [q1.q2, ..., ar de 
variables articulares, mediante el conocimiento de T?, donde T? = T? (q1,42,.... qn), 


n> 


i.e., T es función de las variables de las articulaciones. 


Para un robot manipulador de 6 GDL, la matriz T? puede expresarse como: 


PIE 12 Tis fis 
0 a0 
P= | Ta Ta as raj | Rg 06 | 
5 = =- 
s T31 T32 T33 T34 


0 0 0 1 


De la ecuación anterior se sabe que la matriz R? tiene sólo tres elementos que 
son independientes, y existen otras tres ecuaciones independientes debido a la posi- 
ción del efector final. Por lo tanto, empleando T? es posible obtener sólo seis ecua- 
ciones independientes. En general, la matriz de transformación contendrá funciones 
trigonométricas, por lo que las soluciones de las seis ecuaciones conllevarán a obten- 
er múltiples configuraciones del robot manipulador que permitan poseer la misma 
posición y orientación. 

Se supone que la matriz Tf describe a un robot manipulador de 6 GDL, por 
lo que las variables de las articulaciones del manipulador son q1....,q6, y la matriz 
de transformación puede expresarse como T? = Tf (q1,....q6). Del análisis cinemático 
directo se sabe que la matriz 1 i es función de la variable articular q;. Por lo tanto, el 
problema de cinemática inversa puede resolverse mediante la solución de las siguientes 
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TR = [MR (5.92) 
13 = [m [tro] z] (5:93) 
T = mA e T] (5.94) 
y = ra a (tre ze] (5.95) 
Té = [> [rA A ra [ire 73]]] (5.96) 
r= 7 (7 A 97 (te? [e re) 69m 


La razón por la cual las ecuaciones anteriores anteriores resuelven el problema de 
cinemática inversa es que, por ejemplo, empleando (5.92), se observa que: 


=j > 2 
a La matriz [TP] es una función de qı, mientras que los elementos de Tå son 
cero, constantes o funciones de q2, ..., qe- 


a Los elementos constantes proporcionan ecuaciones algebraicas que se resuelven 
en función de qı, empleando las ecuaciones básicas mostradas en la tabla B.1. 


Las mismas conclusiones anteriores pueden ser establecidas para las demás ecua- 
ciones (5.93)-(5.97), y así se obtienen ecuaciones para las variables de las articulaciones 
42»... qe. Esta técnica es algunas veces denominada Técnica Pieper [1]. 

Para comprender la aplicación de las fórmulas (5.92)-(5.97), se obtendrá la cine- 
mática inversa de un robot de 6 GDL. Además, se mostrarán simulaciones que per- 
miten validar los resultados obtenidos. 

Cinemática inversa para Robot Cilíndrico 

En ésta parte se analizará el problema de cinemática inversa aplicado al robot 
cilíndrico de 6 GDL mostrado en la figura B.1, empleando la técnica de Pieper. 
Posteriormente se empleará la cinemática directa del manipulador para verificar la 
consistencia de los resultados obtenidos. 


Figura B.1 Robot manipulador cilíndrico de 6 GDL. 
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Para comenzar con el análisis de cinemática inversa, se obtiene la cinemática di- 


recta del manipulador. Para ello se emplea la asignación de sistemas de referencia 
mostrada en la figura B.2. 


Figura B.2 Asignación de sistemas de referencia a manipulador cilíndrico. 


Empleando la asignación de sistemas de referencia de la figura B.2, se obtienen los 
parámetros DH mostrados en la tabla B.1. 


Tabla B.1 Parámetros DH para robot manipulador cilíndrico. 


Empleando la tabla de parámetros del manipulador se obtienen las matrices de 
transformación homogénea: 


C1 31 0 o ] 
0 $1 C1 0 0 
ds Dd 0 1 Ñ 
0 0 0 1 
zj -—4 0 0 1.0.0 0 
0 0 -1 -L 0 0 1 dth 
1 2 2 3 3 
igu a -8 0 0 ¡23 0 -1 0 0 
0 0 0 1 0 0 0 1 
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| Ca êi 0 0 ] | Cs —85 0 0 ] 
TÌ = | S4 Ca 0 0 | TÅ 2. | 0 0 —1 0 | 
o 0 0 1 0 UD. — S5 C5 0 0 

| 0 0 0 1] | 0 0 0 1] 
C6 — 8S6 0 0 1. 0 0 0 
5 0 0 1.0 AOLO g 
Te = —86 —C6 0 0 Te E 0 0 1 Le 
0 0 0 1 0.0.0 1 


A partir del análisis cinemático directo se pueden obtener las siguientes matrices 
compuestas: 


—C189 —C]C2 $1 Los 

0 _rpop1_ | 78182 —sic2 —c1 —Laci 
13 o 2 G C2 —$2 0 Li 
0 0 0 1 


=C182 —81 —CiC2 L2sı — [L3 + d3) c1c2 


0 m0m _ | 781852 Ci —siC2 —Laci — [L3 + dz] sica 
q Ca 0 —82 Lı — [L3 + d3] s2 
0 0 0 1 


Nótese de la figura B.2 que el manipulador posee una muñeca esférica, por lo que 
los tres ejes se intersecan en un mismo punto, el cual a su vez coincide con el origen 
del sistema de referencia (3). En manipuladores que cuentan con dicha propiedad 
se comienza el análisis cinemático inverso resolviendo las ecuaciones de las variables 
articulares para el punto en que se intersecan los ejes de dichos sistemas de referencia. 
Se considera que dicho punto expresado en el sistema de referencia base {0} es 0%. 

El problema de análisis cinemático inverso consiste en determinar los valores de las 
variables articulares en función de la posición y orientación del efector final. Debido 
a ello es que se considera que la posición deseada del punto 0% está dada por 0%, y se 
expresa de la siguiente manera: 


0 
034 = Py 
|» ] 
En el análisis de la cinemática inversa a menudo es útil determinar el valor de la 
expresión: 
072 072 072 
[pz] + [py] + [p3] 


debido a que este cálculo puede proporcionar una ecuación útil que conlleve al valor 
de alguna de las variables articulares. Para el robot considerado se tiene: 


pz =  [L2s, — [L3 + d3] c1c2]? 
= Ls} — 2L251 [L3 + da] cıc2 + [L3 + dy)? de 
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p = [-Laci — [L3 + ds] s1c2]? 
= Lick + 2Lc; [L3 + d3] $12 + [L3 + dz]? sd 
p? = [Li — [La + ds] s2)? 


= Li — 2L; [L3 + d3] s2 + [L3 + da]? s2 


por lo que se obtiene: 


p3 E [L3 P dy)? + Li - 2L; [L3 F d3] 82 
PE + [L3 -+ da]? A 


pz + py +p 
pa +p 


En este caso, la ecuación anterior no muestra un beneficio aparente para determi- 
nar 02 o dz, ya que ambas hasta el momento son desconocidas. Entonces, se procede 
a utilizar la técnica de Pieper para obtener los valores deseados de las variables arti- 
culares 01,0. d3. 

Tomando en cuenta la ecuación (5.92), supóngase que la matriz T$; = TÌ repre- 
senta la matriz de transformación con la posición deseada y se escribe de la siguiente 


manera: 
111. T12 Tig p | 


r21 T22 T23 P 
Ta > ~ A 
31 732 T33 Pz 

0 0 0 1 


donde claramente Ty, = T}, (01,02, d3). Entonces, al aplicar la técnica de Pieper se 
obtiene: 
[T] Tu = T3 


č“ u00 0 Tı T12 T13 Pr -s2 0 —c2 -—L3c2-— c2d3 
—8 Ci 0 0 T21 T22 T23 Py E 0 1 0 - Lo 
0 0 1 -L rar T32 T33 Pz: | c2 0 —s2 —L3s2-— d3s2 
0 0 0 1 0 0 0 1 0 0 0 1 


Empleando el elemento (2, 4) de la matriz anterior se concluye que: 


[py] c1 + [px] s1 = [- L22] 


por lo que las dos soluciones para 0, se obtienen aplicando la ecuación (5.89): 


0, = atan 2 (—Pz, Py) + atan 2 (yr? +p? — L3, -L2) (5.98) 
Luego nótese que: 
1371 f0] 1 2 
[T2] [Ty] T3 =T; 
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| =C182 —Si82 C2 -Lic | Mi Ti2 713 Pre | 1 0 0 0 
| =C1C2 —SiC2 —S2 Lisz | rar T22 T23 Py|_ | 0 0 1 d3+L3 | 
$1 =] 0 -L2 r31 T32 T33 Pz 0 -1 0 0 
| 0 0 0 1 | |o 0 O0 1 ] | 0 0 0 1 ] 
por lo que empleando el elemento (1,4) de la ecuación anterior se obtiene: 
—P1C182 — Py8182 + PzC2 — Lica = 0 
[pz — L1] c2 + [—prc1 — Pysı]s2 = 0 
y de la ecuación (5.88) se obtienen las dos soluciones siguientes para 02: 
_ | atan2(p: — Li, Prci + pys1) E 
0 = í atan 2 (— [pz — Lı), —pxc1 — pys1) A) 


donde el valor de 0, se obtiene de (5.98). Finalmente, empleando ahora el elemento 
(2,4) es claro que: 

—PxC1C3 — PyS1C2 — P¿S2 + Lis2 = dz + Ly 
por lo que el valor de d3 se obtiene directamente: 


d3 = L¡82 — PrC1C2 — Py81C2 — P¿S2 — L3 (5.100) 


Ahora se procede a determinar el valor de las variables (04, 05.06). Para ello nótese 
que el valor de la posición no varía para las matrices T? y TÌ, debido a que los orígenes 
de los sistemas de referencia coinciden, por lo que la diferencia entre dichas matrices 
de transformación radica en la orientación. Por lo tanto, considérese la matriz de 
transformación deseada Tf, = Tf: 


mi Mi2 Mi3 Pr 
T? = ma Maz M23 Py | 
m3 M32 M33 Pz 
0 0 0 1 ] 
Aplicando la técnica de Pieper, se obtiene la siguiente expresión: 


TÈ = [131 T% 


La matriz TË se obtiene del análisis cinemático directo como se indica a conti- 
nuación: 


Ed >) = TTTS 

Ca —s4 0 0 5 -s5 0 0 ce -ss 0 0 
a S4 Ca 0 0 0 0 -1 0 0 0 1.0 
a 0 0 1 0 S5 C5 0 0 —$S6 —C6 0 0 
0 o Q 1 0 0 0 1 0 0 0 1 

C4C5C6 — S486 —S4C6 — C4C5S6 —Cass O 

O CaSe + S4C5C6 Cace — 84C5S6 —Sas5s O 

z S5C6 —8586 c5 0 

0 0 0 1 
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mientras que la inversa de la matriz TÌ está dada por: 


0182 —8182 C2 —Lcz 
[To] =1 es —$1 C1 0 La 
" =C1C2 —SiC2 —S2 Lis2-— L3- d3 
| 0 0 0 1 | 
por lo tanto: 
—C182 —81]829 C2 -Licz Mi Mi Miz Pz 
81 cı 0 Lz M2 Ma M2 Py | r? 
=C1C2 —siC2 —s2 Ljs2-— L3- dz M3 M32 M33 Pz s 
0 0 0 1 0 0 0 1 
y del elemento (3,3) de la ecuación anterior se obtiene: 
—C1C2M]3 — $1C2M23 — 32M33 = C5 
Empleando la ecuación (5.86) se obtiene la solución para calcular 05: 
0 = ztatan2(f;, f2) (5.101) 
2 
fii = 1 — [—c1c3m13 — S1C2M23 — S2M33] 
fz = —Cc¡C2M13 — $1C2M23 — S2M33 


Ahora, considerando el elemento (3,1) se obtiene: 
—(1C9M1]1]1 ~ $¡C29Mg91] — S2M31 = S5C6 


y del elemento (3, 2): 


—C1C2M12 — $1C2M22 — S2M32 = — S536 
por lo que: 
a ar AMS + S1C2M22 + S2M32 
w - 1MM 
S5 

Ñ C1CaM1]1 + $1C2M91 + S2M31 

6 = ¡¿qrRXOoOOooQ———— — o ——— 
55 


por lo tanto, empleando la ecuación (5.87), se obtiene la solución para el cálculo de 
06: 


06 = —a tan 2 (c¡c2mM12 + 5102M22 + S2M32,C1C2M11 + $1C2M91 + s2m31) (5.102) 


Finalmente, de los elementos (1,3) y (2,3) se obtiene: 


—(182M13 — $182M293 + C2M33 —C435 


—8,¡M13 + C1¡M23 =  —8485 
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por lo que, dividiendo las ecuaciones anteriores, se concluye que: 
04 = atan2 (s¡mi3 — C¡Ma3,C1$2M13 + $1,82Mo93 — C2M33) (5.103) 
Con los cálculos anteriores, el análisis cinemático inverso del manipulador ha 


quedado completamente determinado, y las ecuaciones generales para determinar las 
variables articulares del manipulador son: 


0 = atan2(—ps, py) + atan? (yp2 +p? — 13,—L») 
de f atan 2 (p; — Li, PzC1 + Py81) 
atan 2 (— [pz — L1], —pxc1 — Pys1) 
da = L¡i82— PrC1C2 — PyS1C2 — Pz82 — L3 
04 = atan2(s;¡mi3 — C1M23,C182M13 + $1$2Mo93 — C2M33) 
0 = +atan2(fı, f2) 
0 = —atan2(c,c3M13 + $1C2M22 + S2M32, C1C2M11 + $,C2M9] + S2M31) 


y la matriz de transformación deseada y conocida que representa la posición y o- 
rientación final está dada por: 


Los resultados anteriores permiten enfocar el análisis de cinemática inversa en el 
centro de la muñeca esférica del manipulador. Para enfocarse en el efector final, sea 
på = [Pz, Py, p:]7 el vector de posición deseado en el centro de la muñeca y sea PS. el 
vector de posición deseado en el efector final, donde: 


E End A E 
lr] O Lo] 


ze 
La matriz R? es conocida debido a que es la orientación deseada, y está dada por: 
mi Mi2 Mi3 
0 
Re = | Mza M2 Ma 


m31 M32 M33 


por lo tanto: 


Pze Pr + mi3L. 
Pie = | Pye | = | Py + MasL. 
Pze Pz + m33 Le 


Alfaomega Cinemática y Dinámica de Robots Manipuladores e Roger Miranda Colorado 


359 


Empleando el análisis anterior es posible obtener las ecuaciones de cinemática 
inversa del manipulador en el efector final por medio del siguiente conjunto de ecua- 
ciones: 


0% = atan2(—pz, py) + atan2 (yp? + p3 — 13,—Lo) 


0 = { atan2 (p, — Li, Prci + PyS1) 
atan 2 (— [p. — Lı], —prc1 — PyS1) 
da = Li82-— prC1C2 — PyS1C2 — Pz82 — L3 
04 = atan2(s¡m;3-— C1¡Ma3,C1$2M13 + $182M93 — C2M33) 
05 = z+Hatan2(f1,f2) 
06 = —atan2(c¡c2m12 + 5102M22 + $2M32,C1C3M]1 + S1C2M21 + S2M31) 
Pr = Pre — Mi3L¿,Py = Pye — M23Le,P: = Pze — M33Le 


Empleando las fórmulas anteriores se realizaron simulaciones del robot. En dichas 
simulaciones se utilizaron las siguientes medidas: 


Lı = 1400.0mm 
Lə = 950.0mm 
L} = 1250.0mm 
Le = 482.6mm 


Para verificar los resultados de la cinemática inversa, se tomarán los valores de las 
variables articulares y se empleará la cinemática directa para reconstruir la trayectoria 
del efector final. Debido a lo anterior se emplea la matriz de transformación homogénea 
T? que relaciona el efector final con el sistema de referencia base: 


D an Op3pő 

pd k T3 Te ie 
M1 Mi2 Miz Pre 
Ma Maz Maz Pye 


M3 M3 Maz Pze 
0 0 0 1 


donde : 


mi11 = C1828486 — C1C285C6 — $184C5C6 — 81486 — C182C4C5C6 

M2 = C1C48S6 + C184C5C6 — $10285C6 + 81828486 — $152C4C5C6 
M31 = C2C4C5C6 — S285C6 — C28486 

M12 = C18284C6 — $1C4C6 + C1C28586 + $184C586 + C182C4C586 

Maz = C1C4C6 — C184C0586 + 81828406 + 51028586 + $1582C4C586 


M3 = S828586 — C284C6 — C2C4C5586 
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M13 = $18485 — C]C2C5 + C182C4585 
M23 = 81820485 — C18485 — 81C2C5 
Maz = —S2C5 — C2C485 
Pze = L281 — [L3 + d3] c1c2 — Loc1c2cs + Los15485 + LeC1820455 
Pye = —Lac1 — [L3 + d3] s1c2 + Los1820485 — Lo510205 — LoC18485 
Pze = Lı — [L3 + d3] s2 — Losacs — Loc2C485 


La trayectoria empleada para verificar el análisis cinemático directo e inverso se 
muestra en la figura B.3, y su descripción matemática es: 


Pza rcost 
Des = | Pye | = rsint 
Pze sin (5t) +1 


Eje y Eje x 


Figura B.3 Trayectoria deseada en el efector final. 


La trayectoria anterior se seguirá con el efector final manteniendo la posición inicial 
con los ángulos: 
04 = 0; = 06 =:0 


por lo que, sustituyendo los valores de 04,05,06 en TY, se obtienen la orientación y 
posición deseadas: 


=C182 —S] —CjcC ze 
hot e pe : Pre r cost ] 
T? = 2 = 0 bs 0 e Pam pjs = rsint (5.104) 
G = iiae | E ] | sin (5t) + 1 ] 


0 0 0 1 
Con la matriz de transformación anterior se asegurará el seguimiento de la trayec- 


toria deseada en el efector final, manteniendo de modo constante la orientación del 
efector final. 
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En la figura B.4 se muestran las gráficas de las señales deseadas en el efector final 
Pre: Pye: Pze, así como los valores calculados del efector final pe, py. pz. Nótese que sólo 
se aprecian tres señales debido a que el error las señales deseadas y las calculadas es 
muy pequeño. 


o 10 15 


Figura B.4 Gráficas de las señales pre, Pye, Pze Y Pes Pys Pz- 


En la figura B.5 se muestran las señales de error entre la trayectoria desea- 
da y la obtenida por medio del cálculo de la cinemática directa. El procedimiento 
para obtener estas señales es el siguiente: tomando como referencia la posición y o- 
rientación deseada en el efector final, se hace el cálculo de los valores de [q1,....q6) = 
101,02. d3, 04,05,06}. Luego, empleando los valores calculados de las variables articu- 
lares, se utiliza el análisis cinemático directo para reconstruir la posición y orientación 
deseadas en el efector final. Finalmente se hace la resta de la posición calculada con 
la deseada para obtener las señales de error mostradas. 


46 Gráfica de error en p, 


Figura B.5 Gráficas de las señales de error entre Pre, Pye, Pze Y Pe: Py: Pz- 


Finalmente, en la figura B.6 se muestra una gráfica comparativa de las trayectorias 
deseada y la obtenida con la cinemática inversa. 
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Figura B.6 Gráfica de la trayectoria deseada y la obtenida empleando los cálculos de cinemática 
inversa. 


En conclusión, el método descrito permite obtener las variables de las articula- 
ciones del manipulador de manera prácticamente exacta. Además, la metodología es 
simple y fácil de aplicar. 


El método descrito puede aplicarse a muchos más tipos de robots manipuladores, 
aunque debe tenerse especial cuidado en que la trayectoria que se desea que siga el 
manipulador se encuentre dentro de su espacio de trabajo. Además, la multiplicidad 
de soluciones que se pueden obtener deben de ser analizadas con cuidado para poder 
obtener los resultados esperados, ya que algunas de las configuraciones que permiten 
seguir la trayectoria deseada no serán compatibles con el diseño físico del manipu- 
lador. 
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